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DESCRIPTION 
GAIT GENERATING SYSTEM FOR MOBILE ROBOT 

Technical Field 
5 The present invention relates to a system for 

generating gaits of a mobile robot, such as a bipedal 
mobile robot. 

Background Art 

10 As techniques for generating desired gaits of a 

mobile robot, such as a bipedal mobile robot, one disclosed 
in, for example, Japanese Unexamined Patent Application 
Publication No. 2002-326173 (patent document 1) and one 
disclosed in PCT international publication WO/03/057427/A1 

15 (patent document 2) have been proposed by the present 

applicant. According to the techniques disclosed in these 
documents, an instantaneous desired gait composed of an 
instantaneous value of a desired motion (instantaneous 
desired motion) of a robot and an instantaneous value of a 

20 desired floor reaction force (instantaneous desired floor 
reaction force) is sequentially created using a first 
dynamic model (simplified model) , which represents a 
relationship between motions of the robot (the positions 
and postures of individual portions) and floor reaction 

25 forces, such that a dynamic balance condition (a condition, 
such as the one in which a translational force component of 
a floor reaction force takes a desired value or floor 
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reaction force moment about a certain point takes a desired 
value) on the first dynamic model is satisfied. Then, the 
instantaneous desired gait is input to a second dynamic 
model (full model) wherein a part of the instantaneous 
5 desired motion (desired body position/posture, a desired 

moment about a desired ZMP, or the like) is corrected so as 
to generate a final instantaneous desired gait in a time 
series manner. According to the technologies disclosed in 
documents 1 and 2, a desired gait is generated for each 

10 step, a gait for the period of one step of a bipedal mobile 
robot being the unit. In this case, to generate an 
instantaneous value of a desired gait for each step of the 
robot, the gait parameter (composed of the parameters 
defining the position/posture trajectory of each foot, the 

15 parameters defining a desired ZMP trajectory, etc.) that 
specifies a normal gait, which is a virtual cyclic gait 
that follows the desired gait, is first determined by using 
the gait parameter and the aforesaid first dynamic model 
such that a predetermined boundary condition (a condition 

20 in that the gait states at the starting end and the 

terminating end, respectively, of one cycle of a normal 
gait coincide with each other) is satisfied. Further, the 
gait parameter defining a desired gait is determined such 
that a gait generated by using the gait parameter and the 

25 aforesaid first dynamic model satisfies a predetermined 
boundary condition (a condition in that the desired gait 
approaches the normal gait at the end side thereof) . Then, 
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the gait parameter of the desired gait determined as 
described above and the first dynamic model are used to 
generate the time series of the instantaneous values of the 
desired gait. 

5 According to the technologies for generating 

desired gaits as described above, a model having high 
linearity is generally used as the first dynamic model 
(simplified model) . Creating instantaneous desired gaits 
by using a dynamic model with high linearity makes it 

10 possible to efficiently and promptly create a gait that 

connects to or gradually approximates a normal gait, which 
is a virtual cyclic gait (a gait that enables the robot to 
continue stable motions) . As a result, instantaneous 
desired gaits of the robot can be sequentially generated in 

15 real time while performing actual motions of the actual 

robot. Moreover, when determining the gait parameter of a 
normal gait, it is possible to efficiently and promptly 
determine the gait parameter that allows the boundary 
condition of the normal gait to be satisfied. 

20 However, a dynamic model with high linearity 

generally tends to have relatively low dynamic accuracy in 
a variety of operations of a robot. More specifically, the 
kinetics of a robot on its dynamic model is prone to errors 
relative to the actual kinetics of an actual robot. For 

25 this reason, if an instantaneous desired gait created using 
the first dynamic model is directly applied to the actual 
robot to make the actual robot operate, then a dynamic 
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balance condition guaranteed on the first dynamic model 
will not be satisfied on the actual robot, frequently 
causing the operations of the actual robot to lack in 
stability. 

5 Hence, in the technologies disclosed in the 

aforesaid patent documents 1 and 2, a part of the 
instantaneous desired gait created using the first dynamic 
model is further subjected to a correction by using a 
second dynamic model. In this case, a model whose dynamic 

10 accuracy is higher than that of the first dynamic model is 
used as the second dynamic model. This makes it possible 
to generate gaits of higher dynamic accuracy (closer to the 
kinetics of an actual robot) than that of gaits created 
using the first dynamic model. 

15 However, in the technologies disclosed in the 

aforesaid patent documents 1 and 2, gaits created using the 
second dynamic model tend to diverge, so that it has been 
necessary to correct a desired ZMP trajectory or generate a 
floor reaction force moment about a desired ZMP so as to 

20 restrain a desired motion trajectory of a robot from 

deviating from a gait created using the first dynamic model. 
And, in this case, the correction amount of the desired ZMP 
trajectory or the floor reaction force moment about the 
desired ZMP occasionally becomes relatively large, and in 

25 such a case, it has become difficult to maintain an ample 
stability margin from time to time. Conversely, if the 
correction amount of the desired ZMP trajectory or the 
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permissible range of the floor reaction force moment about 
the desired ZMP is set to be smaller in order to maintain 
an ample stability margin, then the likelihood of the 
divergence of a gait has inconveniently increased. 
5 Further, when determining the gait parameter of a 

normal gait, if the dynamic accuracy of the first dynamic 
model is set to be high, then the linearity of the first 
dynamic model deteriorates, making it difficult to 
efficiently and promptly find a normal gait parameter that 

10 is capable of satisfying the boundary condition of the 

normal gait. Hence, it has been difficult to determine an 
appropriate normal gait parameter that is resistant to the 
divergence of a gait in the aforesaid second dynamic model. 
As a result, there has been an inconvenience in that 

15 maintaining an ample stability margin is difficult or gaits 
generated using the second dynamic model are apt to diverge, 
as described above. 

The present invention has been made with a view of 
the above background, and it is an object thereof to 

20 provide a gait generating system for a mobile robot that is 
capable of efficiently generating desired gaits that allow 
a predetermined boundary condition to be satisfied, while 
preventing the desired gaits from diverging. Another 
object of the present invention is to provide a gait 

25 generating system for a mobile robot that is, when 

determining a gait parameter defining a normal gait, 
capable of efficiently determining a normal gait parameter 
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that allows the normal gait to satisfy a predetermined 
boundary condition and also of preventing a desired gait 
from diverging. 

5 Disclosure of Invention 

To fulfill the aforesaid objects, according to a 
first invention of a gait generating system for a mobile 
robot, there is provided a gait generating system 
determining a gait parameter, which is composed of a set of 

10 a plurality of parameters defining a gait of a mobile robot 
in a predetermined period, and generating a desired gait of 
the mobile robot in the predetermined period by using the 
determined gait parameter and a dynamic model of the 
aforesaid mobile robot, comprising: 

15 a priority parameter required value determining 

means for determining a priority parameter required value, 
which is the value of a priority parameter to satisfy a 
requirement when the requirement related to the desired 
gait is given and a predetermined parameter out of the gait 

20 parameter is defined as the priority parameter while 

parameters except for the priority parameter are defined as 
non-priority parameters ; 

a base gait parameter setting means for setting, as 
a base gait parameter, either a gait parameter defining a 

25 reference gait of the mobile robot that is prepared 

beforehand or a gait parameter determined in the past so as 
to satisfy a predetermined boundary condition; 
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a priority parameter asymptotic means for updating 
the value of a priority parameter of the base gait 
parameter so as to cause the value of the priority 
parameter to gradually approach the priority parameter 
5 required value in steps until the value agrees with the 
priority parameter required value; and 

a new gait parameter determining means for 
determining in an exploratory manner a new gait parameter 
each time the value of the priority parameter is updated by 

10 the priority parameter asymptotic means, the new gait 
parameter being a gait parameter that has a priority 
parameter of the updated value and that allows a gait 
satisfying the predetermined boundary condition to be 
generated by using the dynamic model, 

15 wherein if the number of updates of the value of a 

priority parameter by the priority parameter asymptotic 
means when the new gait parameter is newly determined is 
denoted by n (n: integer satisfying n>l) , the value of the 
priority parameter obtained by the n-th update processing 

20 is denoted by an n-th priority parameter updated value, a 

new gait parameter to be newly determined is denoted by the 
n-th new gait parameter, and the base gait parameter is 
denoted by a 0-th new gait parameter, then the new gait 
parameter determining means is a means that sets the value 

25 of a non-priority parameter to the value of the non- 
priority parameter of an (n-l)th new gait parameter, 
defines a gait parameter, in which the value of a priority 
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parameter has been set to an n-th priority parameter 
updated value, as an initial search candidate gait 
parameter, and searches for the value of the search object 
parameter, which is a predetermined parameter among non- 
5 priority parameters of the initial search candidate gait 

parameter, such that the value satisfies the predetermined 
boundary condition, thereby determining an n-th new gait 
parameter, and 

the new gait parameter determined at the last 
10 update of the value of a priority parameter by the priority 
parameter asymptotic means is defined as the gait parameter 
defining the desired gait, and the desired gait is 
generated by using the new gait parameter and the dynamic 
model . 

15 Incidentally, in the inventions of the present 

application, including the first invention, a desired gait 
is composed of the time series of the desired instantaneous 
values of motions of a robot (the position/posture of each 
portion or the displacement amount of each joint) or it is 

20 composed of the time series of the desired instantaneous 
values of the motions and the time series of the desired 
instantaneous values of floor reaction forces (at least one 
of translational forces, moments, and points of action) 
acting on the robot. A dynamic model of the robot is a 

25 model that includes at least a motion/floor reaction force 
model (a dynamic equation of the robot) that expresses a 
relationship between motions of the robot and floor 
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reaction forces acting on the robot. A restrictive 
condition related to motions of the robot (e.g., a range in 
which a certain portion of the robot may move or a 
geometric restrictive condition on link mechanisms) or a 
5 restrictive condition related to floor reaction forces (a 
permissible range of a predetermined component of a floor 
reaction force, a range in which the point of action of the 
floor reaction force may exist, etc.) may be added to the 
above dynamic model. In such a case, the dynamic model 

10 combines the restrictive conditions and the aforesaid 

motion/floor reaction force model. Generating a gait by 
using a gait parameter and a dynamic model means 
determining the amount of input to the dynamic model or the 
state amount of the dynamic model on the basis of a gait 

15 parameter and then generating a gait that satisfies the 
dynamics on the dynamic model (the relationship of the 
motion/floor reaction force model or the relationship and 
the added restrictive conditions) . 

According to the aforesaid first invention, each 

20 time the value of a priority parameter is updated by the 

aforesaid priority parameter asymptotic means, the value of 
the priority parameter of the aforesaid new gait parameter 
newly determined by the aforesaid new gait parameter 
determining means agrees with the value of the priority 

25 parameter after the updating by the priority parameter 
asymptotic means. Hence, the value of the priority 
parameter of the new gait parameter approaches in steps a 
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priority parameter required value, i.e., the value of the 
priority parameter for satisfying a requirement related to 
the aforesaid desired gait, from the aforesaid base gait 
parameter (== the 0-th new gait parameter) until it is 
5 updated to finally agree with the priority parameter 
required value. 

An n-th new gait parameter determined at an 
arbitrary n-th update of the value of a priority parameter 
is determined by setting a gait parameter, which is 

10 obtained by setting the value of a non-priority parameter 
to the value of a non-priority parameter of an (n-l)th new 
gait parameter, and by setting the value of a priority 
parameter to the value after the n-th update (the n-th 
priority parameter updated value) , (a gait parameter whose 

15 parameters except for a priority gait parameter are the 
same as those of the (n-l)th new gait parameter) and 
defining the gait parameter as an initial search candidate 
gait parameter, and by searching for the value of the 
search object parameter, which is a predetermined parameter 

20 among non-priority parameters of the initial search 

candidate gait parameter, such that the value satisfies the 
aforesaid predetermined boundary condition. The boundary 
condition is, for example, a condition in that a 
predetermined state amount (e.g., the position or the 

25 posture of a certain portion of a robot or a changing 

velocity thereof, or a floor reaction force) of the gait 
(instantaneous value) at one end (the time of the starting 
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end or the terminating end) of the aforesaid predetermined 
period agrees or substantially agrees with a predetermined 
value . 

In this case, the parameters of the initial search 
candidate gait parameter except for the search parameter 
are the same as those of the n-th new gait parameter to be 
determined. And, the difference between a value of a 
priority parameter of the initial search candidate gait 
parameter and that of the (n-l)th new gait parameter 
previously determined can be sufficiently reduced, so that 
an appropriate search object parameter value of the n-th 
new gait parameter to be newly determined that will satisfy 
the aforesaid predetermined boundary condition will not 
considerably deviate from the value of the search object 
parameter of the (n-l)th new gait parameter. This makes it 
possible to easily and promptly search for a search object 
parameter of the n-th new gait parameter that can satisfy 
the aforesaid boundary condition. 

Then, the aforesaid desired gait is generated by 
using the new gait parameter that has been determined at 
the last update of the value of a priority parameter, that 
is, when the value of the priority parameter finally agreed 
with the aforesaid priority parameter required value, and 
the aforesaid dynamic model. 

Thus, according to the first invention, the value 
of the priority parameter of the gait parameter that 
defines the aforesaid desired gait to be generated is 
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determined by adjusting the value of a search object 
parameter that is not a priority parameter in an 
exploratory manner while gradually (in steps) bringing the 
value of a priority parameter thereof close to a priority 
5 parameter required value, which is a proper required value, 
from the value of a priority parameter of the base gait 
parameter until it can finally satisfy the aforesaid 
boundary condition. In other words, a base gait parameter 
set as a starting point is changed to gradually satisfy the 

10 requirement and the boundary condition related to the 
aforesaid desired gait, thereby determining the gait 
parameter that defines the desired gait. In this case, the 
base gait parameter is either the gait parameter defining a 
reference gait prepared in advance or the gait parameter 

15 determined in the past such that it satisfies a 

predetermined boundary condition, so that it is a gait 
parameter (appropriate as a gait parameter) that will not 
lead to or will be resistant to the occurrence of an 
inconvenience, such as divergence of a gait, when a gait is 

20 generated using the gait parameter and a dynamic model. 

Hence, in the first invention, a gait parameter finally 
determined as the one that defines a desired gait allows a 
gait generated using the gait parameter and the dynamic 
model to be divergence-proof or resistant to divergence. 

25 As described above, a search object parameter of a proper 
new gait parameter can be easily and promptly searched for 
at each update of a priority parameter. As a result, a 
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final gait parameter that defines the aforesaid desired 
gait can be efficiently determined. 

Thus, the first invention makes it possible to 
efficiently determine a normal gait parameter that enables 
5 a normal gait to satisfy a predetermined boundary condition 
and consequently makes it possible to efficiently generate 
a desired gait that is capable of satisfying a 
predetermined boundary condition while preventing the 
desired gait, which is capable of preventing the divergence 

10 of a desired gait, from diverging. Furthermore, since a 

desired gait that does not diverge or that is resistant to 
divergence can be generated, it is no longer necessary to 
significantly correct a desired ZMP or a desired floor 
reaction force moment in a desired gait to prevent 

15 divergence, making it possible to increase a stability 
margin of a mobile robot. 

Further, to fulfill the objects described above, 
according to a second invention of a gait generating system 
of a mobile robot, there is provided a gait generating 

20 system of a mobile robot, when generating a desired gait of 
a mobile robot in a predetermined period, the system 
determining a normal gait parameter, which is composed of a 
set of a plurality of parameters defining a normal gait, 
which is a virtual cyclic gait following the desired gait, 

25 and generating the desired gait such that the desired gait 
approximates a normal gait to be generated by using the 
determined normal gait parameter and a dynamic model of the 
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mobile robot, comprising: 

a priority parameter required value determining 
means for determining a priority parameter required value, 
which is the value of a priority parameter to satisfy a 
5 requirement, when the requirement related to a normal gait 
for the desired gait is input and a predetermined parameter 
out of the normal gait parameter is defined as the priority 
parameter while parameters except for the priority 
parameter are defined as non-priority parameters; 

10 a base normal gait parameter setting means for 

setting, as a base normal gait parameter, either a normal 
gait parameter defining a reference normal gait of the 
mobile robot that is prepared beforehand or a normal gait 
parameter determined in the past so as to satisfy a 

15 predetermined boundary condition; 

a priority parameter asymptotic means for updating 
the value of a priority parameter of the base normal gait 
parameter so as to cause the value to gradually approach 
the priority parameter required value in steps until the 

20 value agrees with the priority parameter required value; 
and 

a new normal gait parameter searching means for 
determining in an exploratory manner, each time a value of 
a priority parameter is updated by the priority parameter 
25 asymptotic means, a new normal gait parameter, which is a 
normal gait parameter that has a priority parameter of the 
updated value and that allows a gait satisfying the 
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predetermined boundary condition to be generated by using 
the dynamic model, 

wherein if the number of updates of the value of a 
priority parameter by the priority parameter asymptotic 
5 means when the new normal gait parameter is newly 

determined is denoted by n (n: an integer satisfying n>l) , 
the value of the priority parameter obtained by the n-th 
update is denoted by an n-th priority parameter updated 
value, a new normal gait parameter to be newly determined 

10 is denoted by an n-th new normal gait parameter, and the 

base normal gait parameter is denoted by a 0-th new normal 
gait parameter, then the new normal gait parameter 
searching means sets the value of a non-priority parameter 
to the value of the non-priority parameter of an (n-l)th 

15 new normal gait parameter, and defines a gait parameter, in 
which the value of a priority parameter has been set to an 
n-th priority parameter updated value, as an initial search 
candidate gait parameter, and searches for the value of the 
search object parameter, which is a predetermined parameter 

20 among non-priority parameters of the initial search 

candidate gait parameter, such that the value satisfies the 
predetermined boundary condition, thereby determining an n- 
th new normal gait parameter, and 

the new normal gait parameter determined at the 

25 last update of the value of a priority parameter by the 
priority parameter asymptotic means is defined as the 
normal gait parameter of a normal gait for the desired gait, 
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and the desired gait is generated such that the desired 
gait approximates a normal gait to be generated by using 
the normal gait parameter and the dynamic model. 

According to the second invention, each time the 
5 value of a priority parameter is updated by the priority 
parameter asymptotic means, the value of the priority 
parameter of the new normal gait parameter newly determined 
by the new normal gait parameter determining means 
coincides with the value of a priority parameter updated by 

10 the priority parameter asymptotic means. Hence, the value 
of a priority parameter of the new normal gait parameter is 
updated such that it approaches in steps a priority 
parameter required value, i.e., the value of a priority 
parameter for satisfying a requirement related to the 

15 normal gait, from the base normal gait parameter (= a 0-th 
new normal gait parameter) , until it finally agrees with 
the priority parameter required value. 

The n-th new normal gait parameter determined at an 
arbitrary n-th update of the value of a priority parameter 

20 is determined by setting the value of a non-priority 

parameter to the value of a non-priority parameter of an 
(n-l)th new normal gait parameter, defining a gait 
parameter (a gait parameter in which parameters except for 
a priority gait parameter are the same as the (n-l)th new 

25 normal gait parameter) obtained by setting the value of a 

priority parameter to a value after an n-th update (an n-th 
priority parameter updated value) as an initial search 
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candidate gait parameter, and searching for the value of a 
search object parameter, which is a predetermined parameter 
out of non-priority parameters of the initial search 
candidate gait parameter such that the predetermined 
5 boundary condition is satisfied. The boundary condition is, 
for example, a condition in that the predetermined state 
amounts (the positions or the postures of a certain portion 
of a robot or changing velocities thereof, or floor 
reaction forces) of a normal gait at both ends of one cycle 

10 of the normal gait (the starting end and the terminating 
end of the period) coincide with each other. 

In this case, the parameters other than the search 
parameter of the initial search candidate gait parameter 
are the same as those of an n-th new normal gait parameter 

15 to be determined. Further, the difference between a 

priority parameter of the initial search candidate gait 
parameter and that of the (n-l)th new normal gait parameter 
previously determined can be sufficiently reduced, so that 
an appropriate search object parameter value of the n-th 

20 new normal gait parameter to be newly determined that will 
satisfy the aforesaid predetermined boundary condition will 
not considerably deviate from the value of the search 
object parameter of the (n-l)th new normal gait parameter. 
This makes it possible to easily and promptly search for a 

25 search object parameter of the n-th new normal gait 

parameter that can satisfy the aforesaid boundary condition. 
Thus, according to the second invention, a normal 
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gait parameter that defines a normal gait for the desired 
gait to be generated is determined by adjusting the value 
of a search object parameter that is not a priority 
parameter in an exploratory manner while gradually (in 
5 steps) bringing the value of a priority parameter thereof 
close to a priority parameter required value, which is a 
proper required value, from the value of a priority 
parameter of the base gait parameter until it can finally 
satisfy the aforesaid boundary condition. In other words, 

10 a base gait parameter set as a starting point is changed to 
gradually satisfy the requirement and the boundary 
condition related to the aforesaid normal gait, thereby 
determining the normal gait parameter that defines the 
normal gait. In this case, the base gait parameter is 

15 either a gait parameter that defines a reference normal 
gait prepared in advance or a normal gait parameter 
determined in the past such that it satisfies a 
predetermined boundary condition, so that it is a proper 
gait parameter that can satisfy the aforesaid boundary 

20 condition when a normal gait is generated using either of 
the above gait parameters and a dynamic model. Therefore, 
the normal gait parameter finally determined as the one 
that defines the normal gait for the aforesaid desired gait 
in the second invention allows a normal gait generated 

25 using it and a dynamic model to properly satisfy the 

boundary condition. Moreover, as described above, a search 
object parameter of a proper new normal gait parameter can 
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be easily and promptly searched for at each update of a 
priority parameter. As a result, a final normal gait 
parameter that defines a normal gait for the aforesaid 
desired gait can be efficiently determined. 

Furthermore, according to the second invention, the 
aforesaid desired gait is generated such that it 
approximates a normal gait that is generated using a new 
normal gait parameter determined at the last update of the 
value of a priority parameter, that is, a new normal gait 
parameter determined when the value of a priority parameter 
finally agrees with the aforesaid priority parameter 
required value and the aforesaid dynamic model; therefore, 
the desired gait will be a gait capable of properly 
enhancing continued stability of a robot on an n-th dynamic 
model, making it possible to prevent the desired gait from 
diverging. In addition, since a desired gait that does not 
diverge or that is resistant to divergence can be generated, 
it is no longer necessary to significantly correct a 
desired ZMP or a desired floor reaction force moment in a 
desired gait to prevent divergence, making it possible to 
increase a stability margin of a mobile robot. 

The first invention and the second invention may be 
combined. More specifically, in the first invention, a 
desired gait in a predetermined period is generated such 
that it approximates a normal gait in the second invention, 
and at this time, the normal gait parameter defining the 
normal gait is determined as in the second invention. In 
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this case, the dynamic model in the first invention and the 
dynamic model in the second invention may be of course the 
same; however, they may alternatively be different. 

In the aforesaid first invention, preferably, the 
5 total number of updates of the value of a priority 

parameter by the priority parameter asymptotic means is set 
on the basis of the difference between the value of a 
priority parameter of. the aforesaid base gait parameter and 
the aforesaid priority parameter required value (a third 

10 invention) . 

Similarly, in the second invention, preferably, the 
total number of updates of the value of a priority 
parameter by the priority parameter asymptotic means is set 
on the basis of the difference between the value of a 

15 priority parameter of the aforesaid base normal gait 

parameter and the aforesaid priority parameter required 
value (a fourth invention) . 

The third invention or the fourth invention 
described above makes it possible to obtain an appropriate 

20 update amount such that the update amount at each update of 
the value of a priority parameter is not excessively large 
or small, allowing efficient search processing of a search 
object parameter of each n-th new gait parameter or each n- 
th new normal gait parameter to be carried out. 

25 Further, in the aforesaid first invention, 

preferably, the aforesaid gait parameter includes a 
parameter that defines a desired ZMP trajectory out of the 
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desired gait as the search object parameter (a fifth 
invention) . 

According to the fifth invention, a desired gait 
that allows the boundary condition to be satisfied can be 
5 generated, while preventing a desired ZMP trajectory from 
significantly deviating from a trajectory suited for 
securing a stability margin for a robot. 

According to the aforesaid second invention, the 
aforesaid normal gait parameter preferably includes, as the 
10 aforesaid search object parameter, a parameter that defines 
a predetermined state amount of a motion of a mobile robot 
at one end of the period of one cycle of the aforesaid 
normal gait (a sixth invention) . 

According to the sixth invention, a normal gait 
15 parameter that satisfies a boundary condition of a normal 
gait is determined by adjusting a predetermined state 
amount of a motion of a mobile robot at one end of the 
period of one cycle of a normal gait, thus making it 
possible to determine a normal gait parameter that defines 
20 a normal gait having a high stability margin. Incidentally, 
a normal gait is a cyclic gait, so that adjusting a 
predetermined state amount of a motion of a robot at one 
end of one cycle thereof means adjusting the predetermined 
state amount of the motion of the robot at the other end of 
25 the one cycle. 

Further, in the first invention described above, 
the aforesaid predetermined boundary condition includes a 
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condition in that a predetermined state amount of a motion 
of a mobile robot at a gait boundary in the aforesaid 
predetermined period agrees with the predetermined state 
amount of the motion of the mobile robot in an adjoining 
5 gait at the boundary (a seventh invention) . 

More specifically, a desired gait must be 
continuous; therefore, when generating a desired gait in 
the predetermined period, a predetermined state amount of a 
motion of a gait of a mobile robot (e.g., the position or 

10 the posture of a certain portion of a certain mobile robot 
or a changing velocity thereof) preferably agrees with a 
predetermined state amount of the motion in a gait adjacent 
to the aforesaid gait at a boundary of a gait in the 
predetermined period (gait at the starting end or the 

15 terminating end of the predetermined period) . 

Further, in the first invention, if a normal gait 
(or a normal gait parameter defining the normal gait) , 
which is a virtual cyclic gait connected to a desired gait 
in the predetermined period is determined and a desired 

20 gait is generated such that it approximates the aforesaid 
desired gait, then the aforesaid predetermined boundary 
condition preferably includes a condition in that a 
predetermined state amount of a motion of a mobile robot at 
the boundary on the terminating end of a gait in the 

25 predetermined period agrees with the predetermined state 

amount of the motion of the mobile robot in the normal gait 
determined as the virtual cyclic gait that is to follow the 
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aforesaid gait (an eighth invention) . 

A gait parameter that makes it possible to generate 
a desired gait approximating a normal gait at the 
terminating end of the desired gait (the terminating end of 
5 the predetermined period) can be efficiently generated by 
determining a boundary condition for the aforesaid desired 
gait as described above. In the eighth invention, a normal 
gait parameter that defines a normal gait may be determined 
as in the second invention, although it does not 
10 necessarily have to be determined in steps as in the second 
invention . 

Further, in the second invention, the predetermined 
boundary condition preferably includes a condition in that 
a predetermined state amount of a motion of a mobile robot 

15 at the starting end of one cycle of the normal gait and 

that at the terminating end thereof agree with each other 
(a ninth invention) . 

A normal gait is a cyclic gait, so that a normal 
gait parameter that allows a normal gait satisfying a 

20 periodicity condition to be generated can be properly 

determined by determining a boundary condition as described 
above. Incidentally, the starting end of one cycle of a 
normal gait in the ninth invention does not necessarily 
have to coincide with the terminating end of the aforesaid 

25 desired gait . 

In the sixth to the ninth inventions described 
above, especially if the aforesaid mobile robot is a legged 
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mobile robot equipped with a plurality of legs extended 
from its body, then the aforesaid predetermined state 
amount preferably includes at least one of the position of 
the body of the robot, the velocity of the body, the 
5 posture angle of the body, the angular velocity of the 

posture angle of the body, the weighted mean values of the 
position and the velocity of the body, the position of the 
total center-of-gravity of the robot, the velocity of the 
total center-of-gravity, the weighted mean values of the 

10 position and the velocity of the total center-of-gravity, 
and a divergence component (a tenth invention) . 

According to this, in the sixth invention, it is 
possible to efficiently determine a normal gait parameter 
that satisfies a boundary condition of a normal gait while 

15 at the same time reducing the aforesaid search object 

parameters. Further, especially in the eighth invention, 
it is possible to efficiently determine a gait parameter 
for bringing a desired gait in the aforesaid predetermined 
period close to a normal gait while at the same time 

20 reducing the search object parameters. In the eighth 

invention, the aforesaid predetermined state amount, in 
particular, is ideally the weighted mean values of the 
position and the velocity of the body of the body or the 
weighted mean values of the position and the velocity of 

25 the total center-of-gravity or a divergence component. 

Best Mode for Carrying Out the Invention 
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The following will explain embodiments of the 
present invention with reference to the accompanying 
drawings. In the embodiments in the present description, 
as mobile robots, bipedal mobile robots will be used as 
5 examples of legged mobile robots. 

Fig. 1 is a schematic diagram showing the outline 
of the entire construction of a bipedal mobile robot to 
which an embodiment of the present invention is applied. 
As shown in the figure, a bipedal mobile robot 
10 (hereinafter referred to as "the robot") 1 is equipped 

with a pair of right and left leg bodies (leg links) 2, 2 
extended downward from a body (a base body of the robot 1) 
3. The two leg bodies 2, 2 share the same construction, 
each having six joints. The six joints are comprised of, 
15 in the following order from the body 3 side, joints 10R, 

10L for turning (rotating) a hip (waist) (for rotation in a 
yaw direction relative to the body 3), joints 12R, 12L for 
rotating the hip (waist) in a roll direction (about an X 
axis) , joints 14R, 14L for rotating the hip (waist) in a 
20 pitch direction (about a Y axis) , joints 16R, 16L for 

rotating knees in the pitch direction, joints 18R, 18L for 
rotating ankles in the pitch direction, and joints 20R, 
20L for rotating the ankles in the roll direction. In the 
present description, the symbols R and L mean that they 
25 correspond to the right side and the left side, 

respectively, of the robot 1. 

A foot (foot portion) 22R(L) constituting a distal 
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portion of each leg body 2 is attached to the bottoms of 
the two joints 18R(L) and 20R(L) of the ankle of each leg 
body 2. The aforesaid body 3 is installed at the 
uppermost top of the two leg bodies 2, 2 through the 
5 intermediary of the three joints 10R(L), 12R(L) and 14R(L) 

of the hip of each leg body 2. A control unit 60 and the 
like, which will be discussed in detail hereinafter, is 
housed in the body 3. For convenience of illustration, 
the control unit 60 is shown outside the body 3 in Fig. 1. 
10 In each leg body 2 having the aforesaid 

construction, a hip joint (or a waist joint) is formed of 
the joints 10R(L), 12R(L) and 14R(L), the knee joint is 
formed of the joint 16R(L), and the ankle joint is formed 
of the joints 18R(L) and 20R(L). The hip joint and the 
15 knee joint are connected by a thigh link 24R(L), and the 

knee joint and the ankle joint are connected by a crus link 
26R(L) . 

A pair of right and left arm bodies 5, 5 is 
attached to both sides of an upper portion of the body 3, 

20 and a head 4 is disposed at a top end of the body 3. Each 
arm 5 is provided with a shoulder joint composed of three 
joints 30R(L), 32R(L), and 34R(L), an elbow joint composed 
of a joint 36 R(L), a wrist joint composed of a joint 
38R(L), and a hand 40R(L) connected to the wrist joint. 

25 The links between shoulder joint and the elbow joint, and 
between the elbow joint and the wrist joint, respectively, 
are formed of rigid bodies. 
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The construction of the robot 1 described above 
imparts six degrees of freedom to the foot 22R(L) of each 
leg body 2 relative to the body 3. During a travel, such 
as walking, of the robot 1, desired motions of the two feet 
5 22R and 22L can be accomplished by driving 6*2=12 joints of 
the two leg bodies 2, 2 together ("*" in this description 
denotes multiplication as scalar calculation, while it 
denotes an outer product in vector calculation) at 
appropriate angles. This arrangement enables the robot 1 

10 to arbitrarily move in a three-dimensional space. 

Furthermore, each arm body 5 is capable of performing a 
motion, such as arm swinging, by rotating the shoulder 
joint, the elbow joint, and the wrist joint thereof. 

As shown in Fig. 1, a publicly known six-axis force 

15 sensor 50 is provided under the ankle joints 18R(L), 20R(L) 
and between the ankle joints and the foot 22R(L) of each 
leg body 2. The six-axis force sensor 50 detects primarily 
whether the foot 22R(L) of each leg body 2 is in contact 
with the ground and also a floor reaction force (ground 

20 contact load) acting on each leg body 2, and it outputs 

detection signals of three-direction components Fx, Fy and 
Fz of a translational force of the floor reaction force and 
three-direction components Mx, My and Mz of a moment to the 
control unit 60. Furthermore, the body 3 is equipped with 

25 a posture sensor 54 for detecting an inclination angle 
(posture angle) of the body 3 relative to a Z-axis 
(vertical direction (gravitational direction) ) and an 
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angular velocity thereof, detection signals thereof being 
output from the posture sensor 54 to the control unit 60. 
The posture sensor 54 is provided with an accelerometer and 
a gyro sensor, which are not shown, and the detection 
5 signals of these sensors are used to detect inclination 
angles of the body 3 and angular velocities thereof. 
Although detailed structures are not shown, each joint of 
the robot 1 is provided with an electric motor 64 (refer to 
Fig. 3) for driving the joint and an encoder (rotary 

10 encoder) 65 (refer to Fig. 3) for detecting a rotational 

amount of the electric motor 64 (a rotational angle of each 
joint) . Detection signals of the encoder 65 are output 
from the encoder 65 to the control unit 60. 

Furthermore, although not shown in Fig. 1, a 

15 joystick (operating device) 73 (refer to Fig. 3) for 

manipulating the robot 1 is provided outside the robot 1. 
The joystick 73 is constructed in such a manner that a 
request or a restrictive condition on a gait of the robot 1, 
such as turning the robot 1 that is traveling straight, 

20 specifying the moving direction of the robot 1, or 

specifying the motion mode of the robot 1, e.g., walking or 
running, or the frictional condition of a floor surface 
(road surface condition) , is input to the control unit 60 
as necessary by operating the joystick 73. Communication 

25 between the joystick 73 and the control unit 60 is effected 
by a wire or wireless means. 

Fig. 2 schematically shows the basic construction 
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of the distal portion (including each foot 22R(L)) of each 
leg body 2 in the present embodiment. As shown in the 
figure, a spring mechanism 70 is installed between each 
foot 22R(L) and the aforesaid six-axis force sensor 50, and 
5 a foot sole elastic member 71 made of rubber or the like is 
bonded to a foot sole (the bottom surface of each foot 
22R,L). These spring mechanism 70 and the foot sole 
elastic member 71 constitute a compliance mechanism 72. 
Although no detailed illustration is given, the spring 

10 mechanism 70 is constructed of a square guide member (not 

shown) , which is installed on the upper surface of the foot 
22R(L), and a piston-shaped member (not shown) that is 
installed adjacently to the ankle joint 18R(L) (the ankle 
joint 20R(L) being omitted in Fig. 2) and the six-axis 

15 force sensor 50 and housed in the guide member through the 
intermediary of an elastic member (rubber or spring) so 
that it is free to move extremely slightly. 

The foot 22R(L) indicated by a solid line in Fig. 2 
is in a state wherein it is being subjected to no floor 

20 reaction force. When each leg body 2 is subjected to a 

floor reaction force, the spring mechanism 70 and the foot 
sole elastic member 71 of the compliance mechanism 72 flex, 
causing the foot 22R(L) to shift to the position/posture 
illustrated by a dashed line in the figure. The structure 

25 of the compliance mechanism 72 is important not only to 

ease a landing impact but also to enhance controllability. 
The details thereof have been explained in, for example, 
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Japanese Unexamined Patent Publication Application No. 5- 
305584 previously proposed by the present applicant, so 
that no further explanation will be given in the present 
description . 

5 Fig. 3 is a block diagram showing a construction of 

the control unit 60. The control unit 60 is comprised of a 
microcomputer, and it includes a first calculator 90 and a 
second calculator 92 formed of CPUs, an A/D converter 80, a 
counter 86, a D/A converter 96, a RAM 84, a ROM 94, and a 

10 bus line 82 for transferring data among them. In the 
control unit 60, output signals of the six-axis force 
sensor 50 of each leg body 2, the posture sensor 54 (an 
accelerometer and a rate gyro sensor), the joystick 73, etc. 
are converted into digital values by the A/D converter 80 

15 and sent to the RAM 84 via the bus line 82. Outputs of the 
encoder 65 (rotary encoder) of each joint of the robot 1 
are input to the RAM 84 via the counter 86. 

As will be discussed hereinafter, the first 
calculator 90 generates desired gaits, calculates a joint 

20 angle displacement command (a command value of a 

displacement angle of each joint or a rotational angle of 
each electric motor 64), and sends the calculation result 
to the RAM 84. The second calculator 92 reads the joint 
angle displacement command and an actual measurement value 

25 of a joint angle detected on the basis of an output signal 
of the encoder 65 from the RAM 84 to calculate a 
manipulated variable required for driving each joint and 



- 31 - 



outputs the manipulated variable to the electric motor 64 
for driving each joint through the intermediary of the D/A 
converter 96 and a servo amplifier 64a. 

Fig. 4 is a block diagram showing major functional 
5 construction of the control unit 60 of the robot 1 in an 
embodiment in the present description. A portion except 
the "actual robot" in Fig. 4 is constituted of processing 
functions implemented by the control unit 60 (primarily the 
functions of the first calculator 90 and the second 

10 calculator 92). The processing function is implemented by 
programs or the like installed in the control unit 60. In 
the following explanation, the aforesaid symbols R and L 
will be omitted as long as it is not particularly necessary 
to discriminate right and left of each part of the robot 1 

15 (the leg bodies 2, the arm bodies 5, etc.) . 

An explanation will now be given. The control unit 
60 is equipped with a gait generating device 100 that 
generates and outputs desired gaits freely in real time, as 
it will be discussed later. The gait generating device 100 

20 implements an embodiment of the present invention by its 
functions. A desired gait output by the gait generating 
device 100 is constituted of a corrected desired body 
posture trajectory (the trajectory of desired postures of 
the body 3), a corrected desired body position trajectory 

25 (the trajectory of desired positions of the body 3) , a 

desired foot position/posture trajectory (the trajectories 
of desired positions and desired postures of each foot 22), 
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a desired arm posture trajectory (the trajectory of desired 
postures of each arm body) , a desired ZMP (desired total 
floor reaction force central point) trajectory, the 
trajectory of corrected desired floor reaction force 
5 moments about a desired ZMP, and a desired total floor 

reaction force trajectory. If a part (a head or the like) 
that can be moved relative to the body 3 is provided in 
addition to the leg bodies 2 and the arm bodies 5, then a 
desired position/posture trajectory of the movable part is 

10 added to a desired gait. 

Here, the definitions and the like of basic terms 
related to gaits in the present description will be 
explained. The term "trajectory" in a gait means a 
temporal change pattern (time series pattern) and it may be 

15 referred to as "pattern" in place of "trajectory." 

Furthermore, a "posture" means a spatial orientation. For 
example, a body posture is represented by an inclination 
angle (posture angle) of the body 3 in the roll direction 
(about the X-axis) relative to the Z-axis (vertical axis) 

20 and an inclination angle (posture angle) of the body 3 in 
the pitch direction (about the Y-axis) , and a foot posture 
is represented by means of a two-axis spatial azimuth 
fixedly set on each foot 22. In the present description, a 
body posture may be referred to as a body posture angle or 

25 a body inclination angle. A desired arm posture related to 
the arm bodies 5 is represented by means of a relative 
posture with respect to the body 3 in the embodiments of 
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the present description. 

The position of the body means the position of a 
predetermined representative point of the body 3 (a certain 
fixed point on a local coordinate system arbitrarily and 
5 fixedly set relative to the body 3). Similarly, the 

position of a foot means the position of a predetermined 
representative point of each foot 22 (a fixed point on a 
local coordinate system arbitrarily and fixedly set 
relative to each foot 22) . For example, the representative 

10 point of each foot 22 is set on the bottom surface of each 
foot 22 (more specifically, for example, a point at which a 
perpendicular line from the center of the ankle joint of 
each leg body 2 to the bottom surface of each foot 22 
intersects with the bottom surface). 

15 The aforesaid corrected desired body posture and 

corrected desired body position related to the body 3 are 
obtained by correcting a certain desired body posture that 
provides a reference (provisional desired body posture) and 
a desired body position (provisional desired body position) . 

20 In the embodiments in the present description, the desired 
body position/posture determined as discussed later (the 
desired body position/posture determined in S032 of Fig. 12, 
which will be discussed later) correspond to the desired 
body position/posture that provide the reference. 

25 In the explanation hereinafter, the term "desired" 

will be frequently omitted if there is no danger of 
misunderstanding . 
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In a gait, the constituent elements except the 
constituent elements related to a floor reaction force, 
namely, the constituent elements related to the 
position/posture of each part of the robot 1, such as foot 
5 position/posture and body position/posture, are referred 

generically to "motions." Further, a floor reaction force 
acting on each foot 22 (a floor reaction force composed of 
a translational force and a moment) is referred to as "the 
each foot floor reaction force," and the resultant force of 

10 "the floor reaction forces of individual feet" related to 

all (two) feet 22R and 22L of the robot 1 is referred to as 
"the total floor reaction force." However, in the 
following explanation, the each foot floor reaction force 
will be hardly referred to, so that "the floor reaction 

15 force" will be handled as synonymous with "the total floor 
reaction force" unless otherwise specified. 

A desired floor reaction force is generally 
represented in terms of a point of action and a 
translational force and moment acting on the point. The 

20 point of action can be set anywhere, so that innumerable 
expressions are conceivable for the same desired floor 
reaction force; if, however, a desired floor reaction force 
is represented using, in particular, a desired floor 
reaction force central point (the desired position of the 

25 central point of a total floor reaction force) as the point 
of action, then the moment component of the desired floor 
reaction force except for a vertical component (the moment 
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component about a vertical axis (Z-axis)) will be zero. In 
other words, a horizontal component (the moment about 
horizontal axes (X-axis and Y-axis) ) of the moment of the 
desired floor reaction force about the desired floor 
5 reaction force central point will be zero. 

In a gait that satisfies a dynamic balance 
condition, the ZMP calculated from a desired motion 
trajectory of the robot 1 (the point at which a moment 
excluding its vertical component becomes zero, the moment 

10 acting about the point due to the resultant force of the 
inertial force calculated from the desired motion 
trajectory and the gravity) coincides with the desired 
floor reaction force central point. This is, therefore, 
equivalent to providing a desired ZMP trajectory in place 

15 of a desired floor reaction force central point trajectory. 

Here, when walking of the robot 1 is performed, the 
vertical component of a translational floor reaction force 
is subordinately determined as the vertical position of the 
body 3 (body height) of the robot 1 is determined by the 

20 technique for determining a body height previously proposed 
in, for example, Japanese Unexamined Patent Application 
Publication No. 10-86080 by the present applicant. 
Furthermore, the horizontal component of the translational 
floor reaction force is also subordinately determined as 

25 the body horizontal position trajectory (or the positional 
trajectory of the total center-of-gravity) of the robot 1 
is determined such that the horizontal component of the 
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moment generated about a desired ZMP by the resultant force 
of an inertial force attributable to a motion of a desired 
gait and gravity becomes zero. For this reason, when 
performing the walking of the robot 1, only the desired ZMP 
5 may be set as the physical amount to be explicitly set in 
relation to the floor reaction force of the desired gait. 

Meanwhile, if a travel of the robot 1, e.g., 
running of the robot 1, is performed with a gait that 
includes a period during which the floor reaction force 

10 becomes zero or substantially zero, then a translational 
floor reaction force vertical component is also important 
in controlling the operation of the robot 1. Hence, it is 
preferred to explicitly set the desired trajectory of the 
translational floor reaction force vertical component and 

15 then to determine the trajectory of a desired body vertical 
position or the like of the robot 1. Also, when the 
walking of the robot 1 is performed, if the robot 1 is to 
travel on a floor surface with a low friction coefficient 
(on a 1ow-|li road) , it is preferred to explicitly set the 

20 desired trajectory of the translational floor reaction 

force vertical component to prevent slippage or the like of 
the robot 1, because the translational floor reaction force 
vertical component (more precisely, the component of the 
translational floor reaction force that is perpendicular to 

25 the floor surface) influences a frictional force. 

Furthermore, according to the embodiments of the present 
invention, in a desired gait finally output by the gait 
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generating device 100, a corrected desired floor reaction 
force moment (a moment whose horizontal component is not 
necessarily zero) is generated about a desired ZMP. 

Thus, in the embodiments in the present description, 
5 the constituent elements related to the floor reaction 
forces of desired gaits output from the gait generating 
device 100 include a corrected desired floor reaction force 
moment about a desired ZMP and a desired translational 
floor reaction force vertical component in addition to a 

10 desired ZMP trajectory. 

And, in the present description, a desired gait 
output by the gait generating device 100 is used to mean "a 
set of a desired motion trajectory and a desired floor 
reaction force trajectory in the period of one step or a 

15 plurality of steps' 7 in a broad sense, and to mean "a set of 
a desired motion trajectory and a desired floor reaction 
force trajectory that includes a desired ZMP, a corrected 
desired floor reaction force moment and a desired 
translational floor reaction force vertical component in 

20 the period of one step" in a narrow sense. 

However, according to the embodiments in the 
present description, in a desired gait (provisional desired 
gait) prepared in the process before a final desired gait 
(a desired gait output from the gait generating device 100) 

25 is determined, the horizontal component of a desired floor 
reaction force moment about a desired ZMP is set to zero as 
defined by an original desired ZMP. Accordingly, in a 
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provisional desired gait other than a desired gait that is 
finally determined, a gait obtained by removing a corrected 
desired floor reaction force moment from the desired gait 
in the aforesaid narrow sense is used to mean a desired 
5 gait. Supplementally, according to the embodiments in the 
present description, a desired gait (a provisional desired 
gait) prepared in the process before a final desired gait 
(a desired gait output by the gait generating device 100) 
is determined is closely associated with the present 

10 invention. Hence, the majority of a desired gait appearing 
in the following explanation will be used to mean a gait (a 
gait that satisfies a desired ZMP) obtained by removing a 
corrected desired floor reaction force moment from a 
desired gait in the aforesaid narrow sense. 

15 In the following explanation, NX a floor reaction 

force vertical component"' will mean "a translational floor 
reaction force vertical component," and the vertical 
component (a component about a vertical axis) of the moment 
in a floor reaction force will use the term "moment" to 

20 distinguish it from "a floor reaction force vertical 

component." Similarly, "a floor reaction force horizontal 
component" will mean "a translational floor reaction force 
horizontal component . " 

"One step" of a desired gait will be used to mean a 

25 period from the moment one leg body 2 of the robot 1 lands 
to the moment the other leg body 2 lands. 

A two-leg supporting period in a gait refers to a 
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period during which the robot 1 supports its own weight by 
the two leg bodies 2, 2, a one-leg supporting period refers 
to a period during which the robot 1 supports its own 
weight only by one leg body 2, and a floating period refers 
5 to a period during which both leg bodies 2, 2 are apart 
from a floor (floating in the air) . In the one-leg 
supporting period, the leg body 2 not supporting the self- 
weight of the robot 1 is referred to as a free leg. A 
running gait of the robot 1, in which the one-leg 

10 supporting period and the floating period are alternately 
repeated, does not have the two-leg supporting period. In 
this case, during the floating period, both leg bodies 2, 2 
do not support the self-weight of the robot 1; however, for 
the sake of convenience, the leg body 2 that was a free leg 

15 and the leg body 2 that was a supporting leg during a one- 
leg supporting period immediately before the floating 
period will be referred to as a free leg and a supporting 
leg, respectively, even in the floating period. 

The trajectory of a desired gait is described using 

20 a global coordinate system (a coordinate system fixed to a 
floor) . As a global coordinate system, a supporting leg 
coordinate system defined, for example, on the basis of 
landing position/posture of the supporting leg foot 22 is 
used. This supporting leg coordinate system is, for 

25 example, a coordinate system in which the point at which a 
perpendicular line extended to a floor surface from the 
center of the ankle joint to which the foot 22 is connected 
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intersects with the floor, while substantially the entire 
bottom surface of the supporting leg foot 22 is in contact 
with the floor, is defined as the origin, and when the 
supporting leg foot 22 is projected onto a horizontal plane 
5 that passes the origin, the longitudinal direction of the 
foot 22 is defined as the X-axis direction and the lateral 
direction thereof is defined as the Y-axis direction (the 
Z-axis direction being the vertical direction) . In the 
following explanation, the X, Y, Z coordinates will mean 

10 the coordinates in this supporting leg coordinate system 
unless otherwise specified. 

Fig. 5 is a block diagram showing the details of 
the gait generating device 100. Referring to this Fig. 5, 
more specific overview of the processing of the gait 

15 generating device 100 will be explained below. 

As illustrated, the gait generating device 100 is 
equipped with a gait parameter determiner 100a. The gait 
parameter determiner 100a determines the values of gait 
parameters that define a desired gait or a time series 

20 table. This gait parameter determiner 100a is responsible 
for the processing related to the core of the present 
invention . 

According to the embodiments in the present 
description, a gait parameter determined by the gait 
25 parameter determiner 100a includes the parameters that 
define a desired foot position/posture trajectory, a 
desired arm posture trajectory, a desired ZMP trajectory, 
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trajectory, respectively, of a desired gait. 

When the gait generating device 100 generates a 
desired gait, estimated landing position/posture and 
5 estimated landing time of the free leg foot 22, or basic 

required values (required parameters) for generating a gait, 
such as the length of a step and moving velocity, are 
supplied to the gait generating device 100 from the 
aforesaid joystick 73 or an action planner (a device for 

10 preparing action plans of the robot 1), which is not shown. 
Alternatively, the gait generating device 100 reads the 
required parameters from a storage medium in which the 
aforesaid required parameters have been stored beforehand 
and retained. Then, the gait parameter determiner 100a of 

15 the gait generating device 100 determines a gait parameter 
on the basis of the required parameters. 

In the embodiments in the present description, the 
gait parameter determined by the gait parameter determiner 
100a also includes parameters that define a reference body 

20 posture trajectory, a ZMP permissible range, and a floor 
reaction force horizontal component permissible range, 
respectively. 

Although the aforesaid reference body posture 
trajectory is not the one finally output from the gait 

25 generating device 100, it is referred to when determining a 
desired gait. The reference body posture trajectory is 
supplied in relation to the body posture of the robot 1 
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from the joystick 73 or the action planner, or it is a body 
posture trajectory generated directly on the basis of a 
requirement (a requirement for retaining a body posture at 
a vertical posture, or the like) that has been set in 
5 advance. A desired body posture (hereinafter, "body 

posture" with no "reference" attached thereto will indicate 
a desired body posture) is generated such that it follows a 
reference body posture for a long time or coincides 
therewith - 

10 To add a supplemental explanation regarding the 

aforesaid ZMP permissible range, in the embodiments in the 
present description, a desired gait is corrected so as to 
generate a corrected desired floor reaction force moment 
(this generally being not zero) about a desired ZMP. 

15 Therefore, the desired ZMP will be a point having a 

different definition from an original definition (the 
definition in that it is a point at which a floor reaction 
force moment horizontal component is zero) , and a ZMP that 
satisfies the original definition (hereinafter referred to 

20 as a true ZMP) moves to a position shifted from the desired 
ZMP by a value obtained by dividing the corrected desired 
floor reaction force moment by a desired floor reaction 
force vertical component. 

The true ZMP of a corrected gait (the desired gait 

25 finally output from the gait generating device 100) must 

fall within at least a range wherein a ZMP can exist (a so- 
called supporting polygon: a range wherein a floor 
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reaction force point of action (ZMP) can exist when it is 
assumed that no adhesive force acts between a floor and the 
bottom surface of the foot 22) . Further, in order to 
secure a sufficient stability margin of the robot 1, the 
5 true ZMP of a corrected gait preferably falls within a 
range near the center in the range wherein the ZMP can 
exist. Hence, in the embodiments in the present 
description, a permissible range wherein a true ZMP of a 
corrected gait can exist is set. This range is called a 

10 ZMP permissible range. The ZMP permissible range is set to 
coincide with a range wherein a ZMP can exist or to be 
included in a range wherein a ZMP can exist. 

As described above, the value obtained by dividing 
a corrected desired floor reaction force moment about a 

15 desired ZMP by a desired floor reaction force vertical 

component indicates the amount of positional deviation of a 
true ZMP from the desired ZMP; therefore, the amount of 
positional deviation of the true ZMP from the desired ZMP 
(a ZMP-converted value of a corrected desired floor 

20 reaction force moment) may be set instead of setting the 
corrected desired floor reaction force moment about the 
desired ZMP. Moreover, a ZMP permissible range can be 
converted into a permissible range of a corrected desired 
floor reaction force moment by multiplying the position of 

25 its boundary by a desired floor reaction force vertical 
component, and the permissible range of the corrected 
desired floor reaction force moment may be set in place of 
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a ZMP permissible range. 

The aforesaid floor reaction force horizontal 
component permissible range is the permissible range of a 
floor reaction force horizontal component that makes it 
5 possible to generate a frictional force having a magnitude 
that prevents the foot 22 from slipping on the surface of 
foot 22 of the robot 1 that is in contact with a floor. 
According to the embodiments in the present description, at 
least a motion (a desired motion) of a desired gait finally 

10 output from the gait generating device 100 is generated 
such that a floor reaction force horizontal component 
balancing out the horizontal component of an inertial force 
of the robot 1 that is produced thereby falls within a 
floor reaction force horizontal component permissible range. 

15 The floor reaction force horizontal component 

permissible range set in the embodiments in the present 
description comes in one for normal gaits set by the 
processing of S022 to be discussed hereinafter, one for 
basic gaits set by the processing of S026, and one for gait 

20 corrections (for full-model corrections) set in S030. 

However, these floor reaction force horizontal component 
permissible ranges do not necessarily have to differ from 
each other; they may be the same. Meanwhile, the ZMP 
permissible range is only the one for gait corrections (for 

25 full-model corrections) set by the processing of S030. 

Supplementally, a gait parameter for generating a 
desired gait includes parameters in addition to the 
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aforesaid parameters. They are determined in the gait 
parameter determiner 100a such that they satisfy 
predetermined boundary conditions. 

The gait parameter determined by the gait parameter 
5 determiner 100a is input to a desired instantaneous value 
generator 100b. Based on the input gait parameter, the 
desired instantaneous value generator 100b sequentially 
calculates (generates) the instantaneous values (values for 
each predetermined control processing cycle of the 

10 aforesaid control unit 60) of the constituent elements of a 
desired gait, such as desired body position/posture, 
desired foot position/posture, a desired ZMP, a desired 
floor reaction force vertical component, a ZMP permissible 
range, and floor reaction force horizontal component 

15 permissible range, by using a dynamic model. Incidentally, 
Fig. 5 shows only some of the desired instantaneous values 
as representative ones. 

The desired instantaneous values calculated by the 
desired instantaneous value generator 100b are input to a 

20 full-model corrector 100c. The full-model corrector 100c 

calculates corrected desired body position/posture obtained 
by correcting the desired body position/posture, which have 
been determined by the desired instantaneous value 
generator 100b, by using a full model as a dynamic model 

25 with high dynamic accuracy, and also calculates a corrected 
desired floor reaction force moment, which is a desired 
value of the horizontal component of a floor reaction force 
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moment about a desired ZMP. 

More generally, the full-model corrector 100c 
carries out processing of El or E2 to satisfy the following 
conditions Dl to D3 . Specifically, the full model 
5 corrector 100c: 

El) corrects the body position/posture of a gait generated 

by the desired instantaneous value generator 100b, 

or 

E2) corrects the body position/posture of a gait generated 
0 by the desired instantaneous value generator 100b and also 
outputs a corrected desired floor reaction force moment 
about a desired ZMP (corrects a desired floor reaction 
force) in order to satisfy the following conditions: 
Dl) A dynamic balance condition is satisfied with accuracy 
5 that is higher than a gait generated by the desired 
instantaneous value generator 100b; 

D2) A true ZMP (a ZMP satisfying the original definition 
that has been corrected by generating a corrected desired 
floor reaction force moment about a desired ZMP) falls 

0 within a ZMP permissible range (a permissible range that 

allows a sufficient stability margin to be maintained) ; and 
D3) A floor reaction force horizontal component falls 
within a floor reaction force horizontal component 
permissible range . 

5 In the embodiments in the present description, the 

processing of E2 is carried out to satisfy the conditions 
Dl to D3. The processing by the full-model corrector 100c 



- 47 - 



in the embodiments in the present description is the same 
as that explained in detail in, for example, PCT 
international publication WO/03/057427 /Al previously 
proposed by the present applicant (specifically, the 
5 processing of S038 shown in Fig. 13 of the publication) . 

Hence, detailed explanation of the processing by the full- 
model corrector 100c in the present description will be 
omitted. 

Further, in the embodiments in the present 
10 description, corrections by the full-model corrector 100c 
are made. Alternatively, however, such correction may be 
omitted, and the instantaneous values of a desired gait 
determined by the desired instantaneous value generator 
100b may be directly output from the gait generating device 
15 100. 

Referring back to Fig. 4, the instantaneous values 
of a desired gait, including the instantaneous values of 
corrected desired body position/posture, a corrected 
desired floor reaction force moment about a desired ZMP, 

20 and desired foot position/posture determined as described 
above, are supplied to a composite-compliance control unit 
101 (the portion enclosed by the dashed line in Fig. 4) . 
The composite-compliance control unit 101 controls a joint 
actuator (an electric motor 64) so as to follow a desired 

25 gait, while maintaining the balance of the robot 1. More 
specific processing of the composite-compliance control 
unit 101 will be discussed later. 
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This completes outlining the gait generating device 

100. 

The embodiment of the present invention will now be 
specifically explained. According to the present 
5 embodiment , for each control processing cycle of the 

aforesaid control unit 60, the gait parameter determiner 
100a determines in steps a parameter for correcting a 
desired ZMP trajectory (more precisely, the parameter that 
defines a desired ZMP trajectory in a gait parameter) or 

10 determines in the exploratory manner parameters other than 
the aforesaid parameter, and uses the determined gait 
parameters and the aforesaid dynamic models so as to 
determine a time series of instantaneous values of a 
desired gait by the desired instantaneous value generator 

15 100b. In this case, a gait parameter related to a gait 

that has already been prepared is used as an initial value, 
and some parameters in the gait parameter are brought close 
in steps to a gait parameter determined for the gait to be 
prepared, a predetermined parameter among the remaining 

20 parameters being determined in an exploratory manner. 

A body motion mode and dynamic models used for 
generating gaits in the present embodiment will now be 
explained. 

In a gait that includes a floating period, such as 
25 a running gait, or walking on a low-friction floor surface, 
there are cases where a dynamic balance condition cannot be 
satisfied while the floor reaction force horizontal 
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component of a desired gait being within a permissible 
range (or within a friction limit) simply by adjusting a 
body horizontal acceleration. Hence, in the present 
embodiment, two motion modes (a body translation mode and a 
5 body rotation mode) of the body 3 explained below are 
compositively generated so as to satisfy the dynamic 
balance condition while the floor reaction force horizontal 
component of a desired gait remains within a permissible 
range (or within friction limits) . 

10 As shown in Fig. 6(a), if only a body horizontal 

acceleration is perturbed from a certain motion state, then 
the total center-of-gravity horizontal acceleration and the 
angular momentum about the total center-of-gravity are 
perturbed. More specifically, in the perturbation of the 

15 body horizontal acceleration, the floor reaction force 

moment about a desired ZMP (excluding the component about a 
vertical axis) and a floor reaction force horizontal 
component (to be precise, a translational floor reaction 
force horizontal component) are perturbed without 

20 perturbing a floor reaction force vertical component that 
dynamically balances out the resultant force of the 
inertial force generated thereby and gravity. This motion 
mode is referred to as the body translation mode. 

In other words, a motion in which the horizontal 

25 component of a floor reaction force moment about a desired 
ZMP and a floor reaction force horizontal component 
(translational floor reaction force horizontal component) 
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are changed without changing a floor reaction force 
vertical component is referred to as the body translation 
mode . 

A change in the floor reaction force moment 
5 component per unit acceleration at that time is denoted by 
AMp and a change in the floor reaction force horizontal 
component per unit acceleration is denoted by AFp. If the 
body 3 in the state shown in Fig. 6(a) is horizontally 
accelerated forward, then AMp and AFp act in the directions 

10 of the arrows shown in Fig. 6(a). 

For the ease of sensory perception, a floor 
reaction force balancing out the resultant force of an 
inertial force generated by a motion and gravity has been 
used for the representation; however, a representation 

15 using the resultant force of the inertial force and gravity 
is theoretically accurate. Incidentally, the aforesaid 
resultant force and floor reaction force have the same 
magnitude but are in the opposite directions. 

Meanwhile, if a body posture angular acceleration 

20 is perturbed about a certain point Pr from a certain motion 
state as shown in Fig. 6(b), then the angular momentum 
about the total center-of-gravity is perturbed without the 
total center-of-gravity being perturbed. This means that 
the body posture angular acceleration perturbation about 

25 the point Pr perturbs the horizontal component of the floor 
reaction force moment about a desired ZMP without causing a 
floor reaction force vertical component and a floor 
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reaction force horizontal component (strictly speaking, a 
translational floor reaction force vertical component and a 
translational floor reaction force horizontal component) to 
be perturbed. This motion mode is referred to as the body 
5 rotation mode. 

In other words, the motion in which the horizontal 
component of a floor reaction force moment about a desired 
ZMP is changed without causing a change in a floor reaction 
force vertical component and a floor reaction force 
10 horizontal component is referred to as the body rotation 
mode . 

A change in the floor reaction force moment 
component per unit angular acceleration at that time is 
denoted by AMr and a change in the floor reaction force 

15 horizontal component per unit angular acceleration is 

denoted by AFr. AFr is zero. If an angular acceleration 
is applied such that the body inclines forward in the state 
shown in Fig. 6(b), then AMr acts in the direction of an 
arrow shown in Fig. 6(b). 

20 The motions of the body 3 include a body vertical 

movement mode in addition to the body translation mode and 
the body rotation mode. This is a motion for moving the 
body 3 in the vertical direction. 

In the first embodiment, the desired instantaneous 

25 value generator 100b generates gaits by using dynamic 

models shown below. In the present embodiment, the dynamic 
models shown in, for example, Fig. 7 are used as the 
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dynamic models. 

Referring to Fig. 7, the dynamic model is a model 
composed of a total of three mass points, namely, two mass 
points (foot mass points) 2m, 2m corresponding to the 
5 individual leg bodies 2 of the robot 1 and a mass point 
corresponding to the body 3 (body mass point) 24m, and a 
flywheel FH that has inertia but no mass. The body mass 
point is a point that has a certain positional relationship 
with the representative point of the body 3 in a local 

10 coordinate system arbitrarily set fixedly on the body 3. 
Similarly, each foot mass point is a point that has a 
certain positional relationship with the representative 
point of the foot 22 in a local coordinate system 
arbitrarily set fixedly on the foot 22 corresponding 

15 thereto. This dynamic model is the dynamic model 
illustrated in PCT international publication 
WO/03/057427/A1 previously proposed by the present 
applicant. Hence, detailed explanation will be omitted in 
the present description. The dynamics of the dynamic model 

20 is represented by expressions 2a to 2c when variables are 
defined as follows. Here, for easy understanding of the 
present description, only the dynamic equations 
(expressions indicating the relationships between motions 
and floor reaction forces) on a sagittal plane (plane 

25 including a longitudinal axis (X axis) and a vertical axis 
(Z axis) ) will be described, and the dynamic equations on a 
lateral plane (plane including a lateral axis (Y axis) and 
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the vertical axis (Z axis) ) will be omitted. 
Zsup2: Vertical position of supporting leg mass point; 
Zswg2: Vertical position of free leg mass point; Zb2 : 
Vertical position of body mass point; ZGtotal2: Vertical 
5 position of the total center-of-gravity; Xsup2 : Horizontal 
position of supporting leg mass point; Xswg2 : Horizontal 
position of free leg mass point; Xb2 : Horizontal position 
of body mass point; XGtotal2: Horizontal position of total 
center-of-gravity; 0by2 : Body posture angle about Y-axis 

10 relative to vertical direction (inclination angle); mb2 : 

Mass of body mass point; msup2 : Mass of supporting leg mass 
point; mswg2 : Mass of free leg mass point; mtotal: Total 
mass of robot (=mb2+msup2+mswg2 ) ; J: Body inert ial moment 
(Equivalent inertial moment in the body rotation mode); Fx: 

15 Floor reaction force horizontal component (specifically, 
the component in the longitudinal direction (X axis) of a 
translational floor reaction force); Fz : Floor reaction 
force vertical component (specifically, the component in 
the vertical direction (Z axis) of a translational floor 

20 reaction force) ; and My: Floor reaction force moment about 
a desired ZMP (specifically, the component about a lateral 
axis (Y axis) of a floor reaction force moment) . 
Fz=mb2* (g+d2Zb2/dt2) +msup2* (g+d2Zsup2/dt2 ) 

+mswg2* (g+d2Zswg2/dt2 ) Expression 2a 

2 5 Fx=mb2*d2Xb/dt2+msup2*d2Xsup2/dt2+mswg2*d2Xswg2/dt2 

Expression 2b 

My=-mb2* (Xb2-Xzmp) + (g+d2Zb2/dt2 ) +mb2* (Zb2-Zzmp) *d2Xb2/dt2 
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-msup2* (Xsup2-Xzmp) * (g+d2Zsup2/df 2) 
+msup2* (Zsup2-Zzmp) *d2Xsup2 /dt2 
-mswg2* (Xswg2-Xzmp) * (g+d2Zswg2/dt2 ) 
+mswg2* (Zswg2-Zzmp) * (d2Xswg2/dt2 ) +J*d29by/dt2 

5 Expression 2c 

The following relational expression holds for the 
position of the total center-of -gravity of a robot: 
ZGtotal2= (mb2*Zb2+msup2*Zsup2+mswg2*Zswg2 ) /mtotal 

...Expression 2d 
10 XGtotal2= (mb2*Xb2+msup2*Xsup2+mswg2*Xswg2) /mtotal 

...Expression 2e 

The dynamic model is constructed such that the 
dynamics of the leg bodies 2, 2 (the dynamics of the mass 

15 points 2m, 2m) and the dynamics of the body 3 (the dynamics 
of the mass point 24m and the flywheel FH) do not interfere 
with each other, the dynamics of the entire robot 1 being 
expressed by the linear combinations thereof. Further, the 
relationship between the motions of the body 3 and floor 

20 reaction forces is divided into the relationship between 
the translational motions of the body 3 (the body 
translation mode) and floor reaction forces and the 
relationship between the rotational motions of the body 3 
(the body rotation mode) and floor reaction forces. To be 

25 specific, a floor reaction force generated by a horizontal 
motion of the body mass point 24m corresponds to a floor 
reaction force generated by a horizontal translational 
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motion of the body 3 (the body translation mode) , and a 
floor reaction force generated by a rotational motion of 
the flywheel corresponds to a floor reaction force 
generated by a rotational motion of a posture angle of the 
5 body 3 (the body rotation mode) . 

The mass of the arm bodies of the robot 1 is 
included in the body mass point 24m, and the body mass 
point 24m has the mass that includes the mass of the arm 
bodies. In the present embodiment, as it will be discussed 

10 later, the motions of the arm bodies (arm swinging motion) 
in a desired gait are performed such that the relative 
position of the total center-of -gravity of both arm bodies 
in relation to the body 3 remains unchanged while canceling 
the moment of an inertial force about the vertical axis 

15 that is generated in the robot 1 by a motion other than the 
arm swinging of the robot 1; therefore, the influences on a 
floor reaction force moment exerted by the arm swinging 
motions of the arm bodies (excluding the component about 
the vertical axis) and the influences exerted on a floor 

20 reaction force horizontal component are ignored. 

The full model used in the aforesaid full-model 
corrector 100c is a multi-mass-point model having a mass 
point in each link of the robot 1, as shown in, for example, 
Fig. 8. In this case, the each link of the robot 1 may 

25 have inertia about the mass point corresponding thereto. 

The processing of the gait generating device 100 
will now be explained in more detail. 
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The gait generating device 100 in the present 
embodiment defines, as the unit, the desired gait (the 
desired gait in the aforesaid narrow sense) for the period 
of one step from the moment one leg body 2 of the robot 1 
5 lands to the moment the other leg body 2 lands, and 

generates desired gaits in order for the period of the one 
step. Here, the desired gait to be newly generated is 
referred to as "the current time's gait," the next desired 
gait is referred to as "the next time's gait," and the 

10 further next desired gait is referred to as "the next but 
one time's gait." Further, the desired gait generated 
immediately before "the current time's gait" is referred to 
as "the last time's gait." The "current time's gait" 
corresponds to "the desired gait in a predetermined period" 

15 in the present invention. 

When the gait generating device 100 newly generates 
a current time's gait, the required values (requests) or 
the like of the estimated landing positions/postures and 
the estimated landing time of the free leg foot 22 of the 

20 robot 1 for two steps ahead are input as required 

parameters for the gait to the gait generating device 100 
(or the gait generating device 100 reads the required 
parameters from storage) . Then, based on these required 
parameters, the gait generating device 100 generates a 

25 corrected desired body position/posture trajectory, a 

desired foot position/posture trajectory, a desired ZMP 
trajectory, a desired floor reaction force vertical 
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component trajectory, a desired arm posture trajectory, a 
corrected desired floor reaction force moment trajectory, 
and the like. In the present embodiment, required 
parameters include the parameters that specify the 
5 requirement on a reference body posture, the requirement on 
a relative arm posture in relation to a body posture, the 
requirement on the pattern of a desired floor reaction 
force vertical component, and the requirement on a floor 
friction force (or a friction coefficient) in addition to 

10 the required values of the estimated landing 

position/posture and the estimated landing time of the free 
leg foot 22 for two steps ahead. The requirement on the 
reference body posture is, for example, the requirement for 
maintaining the body posture at a vertical posture, and the 

15 requirement on an arm posture is, for example, the 
requirement for maintaining the arm posture at a 
predetermined posture relative to the body 3. Further, the 
requirement on the pattern of a desired floor reaction 
force vertical component is typically the requirement for 

20 setting a desired floor reaction force vertical component 
to zero in a floating period of the robot 1 and for 
changing the desired floor reaction force vertical 
component in the form of a trapezoidal pattern in a one-leg 
supporting period. Further, the requirement on the 

25 friction force of a floor is typically the requirement for 
setting a certain range of desired floor reaction force 
horizontal components in relation to the limit of friction 
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forces determined by the product of a desired floor 
reaction force vertical component and a friction 
coefficient (required value) . 

The details of the gait generation processing of 
5 the gait generating device 100 will be given below with 
reference to Fig. 9 to Fig. 22. Fig. 9 is a flowchart 
(structured flowchart) showing the main routine of the gait 
generation processing executed by the gait generating 
device 100. The procedure of the main routine processing 

10 itself is the same as that in, for example, the aforesaid 
PCT international publication WO/03/057427/A1 (hereinafter 
referred to as "publication document 1") by the present 
applicant except for a part of its subroutine processing. 

First, in S010, various types of initializations 

15 are performed, including the initialization of time t to 
zero. This processing is performed when the gait 
generating device 100 is started up or the like. 
Subsequently, the procedure advances to S014 via S012, and 
the gait generating device 100 waits for a timer interrupt 

20 for each control cycle (the calculation processing cycle in 
the flowchart in Fig. 9) . The control cycle is denoted by 
At. 

Subsequently, the procedure proceeds to S016 
wherein it is determined whether the gait is changing, and 
25 if the gait is changing, then the procedure proceeds to 
S018, or if the gait is not changing, then the procedure 
proceeds to S030. Here, the aforesaid "the change of a 
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gait" means the timing at which the generation of a current 
time's gait is begun after the generation of the last 
time's gait has been completed. For example, a control 
cycle following the control cycle in which the generation 
of the last time's gait has been completed is the timing of 
a gait change. 

When the procedure proceeds to S018, time t is 
initialized to zero, then it proceeds to S020 wherein a 
next time's gait supporting leg coordinate system, a next 
but one time's gait supporting leg coordinate system, a 
current time's gait cycle, and a next time's gait cycle are 
read. These supporting leg coordinate systems and gait 
cycles are decided by the aforesaid required parameters. 
More specifically, in the present embodiment, the required 
parameters supplied from a joystick 44 or the like to the 
gait generating device 100 include the required values of 
the estimated landing positions/postures of the free leg 
foot 22 (the foot positions/postures in a state wherein, 
after landing, the foot 22 is rotated without a slippage 
such that substantially the entire foot sole thereof is in 
contact with a floor surface) and estimated landing time 
for two steps ahead. The required value for the first step 
and the required value for the second step are supplied as 
the ones corresponding to the current time's gait and the 
next time's gait, respectively, to the gait generating 
device 100 before the generation of the current time's gait 
begins (at the gait change timing of the aforesaid S016) . 
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Incidentally, these required values can be changed in the 
middle of the generation of the current time's gait. 

Then, the next time's gait supporting leg 
coordinate system is decided on the basis of the required 
5 values of the estimated landing position/posture of the 
first-step free leg foot 22 (the free leg foot 22 in the 
current time's gait) in the aforesaid required parameters. 
Further, the next but one time's gait supporting leg 
coordinate system is decided on the basis of the required 

10 values of the estimated landing position/posture of the 

second-step free leg foot 22. Further, the current time's 
gait cycle is defined as the time from the estimated 
landing time (required value) of the supporting leg foot 22 
of the current time's gait to the estimated landing time 

15 (required value) of the free leg foot 22 of the first step 

(the current time's gait), and the next time's gait cycle 
is defined as the time from the estimated landing time 
(required value) of the first-step free leg foot 22 to the 
estimated landing time (required value) of the second-step 

20 free leg foot 22. 

The processing of S020 is the same as the 
processing of S020 of Fig. 13 in the aforesaid publication 
document 1, so that no further explanation will be given in 
the present description. 

25 Subsequently, the procedure proceeds to S022 

wherein the gait generating device 100 determines the gait 
parameters of a normal gait (normal gait parameter) as a 
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virtual cyclic gait that follows the current time's gait. 
As the gait parameters determined here, there are a foot 
trajectory parameter that defines a desired foot 
position/posture trajectory of each foot 22 in the normal 
5 gait, a reference body posture trajectory parameter that 

defines the body posture trajectory providing a reference, 
an arm posture trajectory parameter that defines a desired 
arm posture trajectory, a ZMP trajectory parameter that 
defines a desired ZMP trajectory, a floor reaction force 

10 vertical component trajectory parameter that defines a 

desired floor reaction force vertical component trajectory, 
and a parameter that defines a desired floor reaction force 
horizontal component permissible range. 

The "normal gait" in the present description is 

15 used to mean a cyclic gait that does not develop 

discontinuity in the motion states (the states of foot 
position/posture, body position/posture, and the like) of 
the robot 1 at the boundaries of gaits when the gait is 
repeated. The "normal gait" includes, of course, a cyclic 

20 gait for the robot 1 to advance straight and also includes 
a cyclic gait for the robot 1 to turn. In this case, 
setting the turning rate to zero means advancing straight; 
therefore, "turning" includes advancing straight in a broad 
sense. For this reason, the "normal gait" may be 

25 frequently referred to as "normal turning gait" in the 
embodiments in the present description. 

The normal turning gait is explained in detail in, 
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for example, the aforesaid publication document 1 and 
Japanese Patent Application No. 2000-352011, so that 
detailed explanation thereof in the present description 
will be omitted. The outline thereof being given below. 
5 In the present embodiment, the normal turning gait, 

which is a cyclic gait, is the gait for two steps of the 
robot 1. In other words, a gait composed of the first 
turning gait following the current time's gait and the 
second turning gait following the first turning gait is 

10 defined as the gait for one cycle of the normal turning 
gait, and the gait for one cycle is repeated. If the 
current time's gait to be generated is, for example, a 
running gait for the robot 1 to run (gait having a one-leg 
supporting period and a floating period) , then the first 

15 turning gait and the second turning gait of the normal 
turning gait are also running gaits, while if it is a 
walking gait for the robot 1 to walk (a gait having a one- 
leg supporting period and a two-leg supporting period) , 
then the first turning gait and the second turning gait of 
.20 the normal turning gait are also running gait. This means 
that the basic gait modes of the first turning gait and the 
second turning gait are the same as those of the current 
time's gaits. 

In the following explanation, unless otherwise 

25 specified, running gaits will be taken as examples of the 
gaits to be generated. 

Normal turning gaits are provisionally prepared to 
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determine the state amounts of a motion of the robot 1, 
such as a divergence component, a body vertical 
position/velocity, a body posture angle, and the angular 
velocity thereof, at the terminating end of the current 
5 time's gait in the gait generating device 100, and they are 
not directly output from the gait generating device 100. 

Incidentally, "divergence" means that the position 
of the body 3 of the robot 1 is undesirably shifted to a 
position that is far apart from the positions of both feet 

10 22 and 22. The value of a divergence component is a 

numeric value that indicates how far the position of the 
body 3 of the robot 1 is apart from the positions of both 
feet 22 and 22 (more specifically, the origin of the global 
coordinate system (supporting leg coordinate system) set on 

15 the ground contact surface of the supporting leg foot 22) . 

For instance, in the embodiments in the present description, 
a divergence component relative to each dynamic model 
described above is determined according to the following 
expression . 

20 

Divergence component = Body mass point horizontal 
position + Body mass point horizontal velocity / coO 
Expression 3 

25 coO in this expression 3 denotes a predetermined 

value. For a divergence component in a gait, a body 
horizontal position and a body horizontal velocity are used 
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in place of the body mass point horizontal position and the 
body mass point horizontal velocity in expression 3 to 
determine the divergence component. 

In the embodiments in the present description, 
5 gaits (current time's gaits) are generated using divergence 
components as indicators such that desired gaits are 
continuously generated without causing the aforesaid 
divergence. More specifically, a current time's gait is 
generated such that a normal gait (more precisely, a normal 

10 gait parameter) following a current time's gait to be 
generated is determined on the basis of the required 
parameters or the like related to the aforesaid current 
time's gait, an initial divergence component of the normal 
gait is determined, and then the terminating divergence 

15 component of the current time's gait is made to agree with 
the initial divergence component of the normal gait (more 
generally, the current time's gait is made to follow or 
approximate the normal gait) . 

Returning to the main subject, in S022, the gait 

20 parameter of the normal gait is determined according to the 
flowchart of the subroutine processing shown in Fig. 10. 
More specifically, the parameters that define the foot 
trajectory parameter, the reference body posture trajectory 
parameter, the arm trajectory parameter, the ZMP trajectory 

25 parameter, the floor reaction force vertical component 
trajectory parameter, and the parameter defining the 
desired floor reaction force horizontal component 
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permissible range related to a normal gait described above 
are individually determined by the processing of S100 to 
S110. Then, in S112, initial time Ts of the normal gait 
and a one-step period (the time for one cycle of the normal 
5 gait) Tcyc are redefined. The processing is the same as 

the processing of the flowchart of Fig. 15 in the aforesaid 
publication document 1, so that detailed explanation 
thereof will be omitted. The parameters of the normal gait 
determined in S100 to S110 are the parameters that are 

10 determined to preferentially satisfy the requirements 

related to the gait, which are represented by the required 
parameters described above, while the trajectories 
specified by the individual parameters satisfy the 
periodicity of the normal gait at the same time. For 

15 example, as explained with conjunction with the flowchart 
of Fig. 15 in the aforesaid publication document 1, the 
foot trajectory parameter of the normal gait is determined 
such that the estimated landing position/posture of the 
free leg foot 22 of the first turning gait following the 

20 current time's gait (the estimated landing position/posture 
observed in the aforesaid next time's gait supporting leg 
coordinate system) agree with the estimated landing 
position/posture (required values) of the second step 
described above, and the estimated landing position/posture 

25 of the free leg foot 22 of the second turning gait (the 
estimated landing position/posture observed in the 
aforesaid next but one time's gait supporting leg 
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coordinate system) agree with the estimated landing 
position/posture (required values) of the free leg foot 22 
of the current time's gait. The ZMP trajectory parameter 
is determined on the basis of a foot trajectory parameter 
5 such that a desired ZMP is positioned substantially near 

the center of the ground contact surface of the supporting 
leg foot 22 and continuously changes over the entire period 
of the normal gait. 

The initial time Ts of the normal gait redefined in 

10 S112 of Fig. 10 means the time of the start point of one 

cycle when creating gaits for one cycle of the normal gait, 
as will be described later (this differs from the time of 
the terminating end of the current time's gait in the 
present embodiment) , and it is the time immediately before 

15 the start of the floating period (the timing when a desired 
floor reaction force vertical component becomes zero) of 
the first turning gait. Further, the one-step period Tcyc 
of the normal gait is the period of the total time of the 
first turning gait and the second turning gait of the 

20 normal gait. The normal gait is a gait whose state at 
arbitrary time Tx (the state of the position/posture of 
each portion of the robot 1 and the changing velocities 
thereof) becomes the same as the state at time Tx+Tcyc 
because of the periodicity thereof. The normal gait is a 

25 cyclic gait having the gait for two steps as one cycle; 

therefore, in the present description, the one-cycle period 
(the total time of the first turning gait and the second 
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turning gait) is regarded as one-step period of the normal 
gait . 

Supplementally, the parameters of the normal gait 
determined by the processing of S100 to S110 are the 
5 parameters that are determined to preferentially satisfy 
the requirements related to the normal gait, so that they 
correspond to the priority parameters in the aforesaid 
second invention, and the determined values correspond to 
priority parameter required values. Thus, the processing 

10 of S100 to S110 corresponds to the priority parameter 

required value determining means in the second invention. 
Further, the parameters of the normal gait determined by 
the processing of S100 to S110 are not all the parameters 
constituting the normal gait parameter. In addition to 

15 these, a variety of parameters are included in the gait 
parameters of a normal gait. In the present embodiment, 
the parameters constituting a normal gait parameter include, 
for example, the position and velocity of the body 3 and 
the posture angle of the body 3 and the angular velocity 

20 thereof at the starting end (the start time of the period) 
or the terminating end (the end time of the period) of the 
one-cycle period of the normal gait and the peak value of a 
body inclination restoring moment ZMP-converted value, 
which will be discussed hereinafter, in addition to the 

25 parameters (priority parameters) determined in S100 to S110. 
Of these parameters, the horizontal position and horizontal 
velocity of the body 3, the angular velocity of a posture 
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angle of the body 3, and the peak value of the body 
inclination restoring moment ZMP-converted value are 
determined in the exploratory manner by the processing of 
S024, which will be discussed hereinafter, such that the 
5 boundary condition of a normal gait (a condition in that 

the state at arbitrary time of the normal gait coincides or 
substantially coincides with the state at the time after 
one cycle) is satisfied. The normal gait parameter is a 
gait parameter that allows a normal gait to be uniquely 
10 generated using the values of the parameters constituting 

the normal gait parameter and the aforesaid dynamic models. 

The parameters constituting normal gait parameters 
are roughly divided into the aforesaid priority parameters 
and the remaining non-priority parameters. The non- 
15 priority parameters include the parameters determined in 
the exploratory manner as described above (the search 
object parameters in the aforesaid second invention) . The 
non-priority parameters of normal gait parameters include 
parameters fixedly determined without depending upon the 
20 requirements related to gaits or the boundary conditions 

related to gaits. For example, in the present embodiment, 
the lifting height of the free leg foot 22 of the robot 1 
(the relative height in relation to the ground contact 
surface of the supporting leg foot 22) is a parameter that 
25 is fixedly set. It would be wasteful to set a parameter 
that is fixedly set in the processing of S100 to S110 for 
every control processing cycle; therefore, such a parameter 
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may be stored in a ROM or set in various types of 
initialization processing (S010 in Fig. 9) carried out 
immediately after the power of the control unit 60 is 
turned on. 

5 There are also lower parameters subordinately 

determined from a single or a plurality of upper parameters. 
For example, in the present embodiment , a body posture at 
the beginning (the aforesaid time Ts) of a normal gait is 
regarded as the same as a reference body posture and it is 

10 subordinately determined from a reference body posture 
trajectory parameter. In the present description, a 
parameter subordinately determined from one upper parameter 
is regarded as a parameter having the same attribute (the 
attribute indicating whether the parameter is a priority 

15 parameter, a non-priority parameter, a search object 
parameter, or a fixed parameter) as that of the upper 
parameter. Regarding a lower parameter determined on the 
basis of a plurality of upper parameters, if the upper 
parameters include a search object parameter, then the 

20 lower parameter is regarded also as a search object 

parameter, or if the upper parameters do not include any 
search object parameters but include a priority parameter, 
then the lower parameter is regarded as a priority 
parameter. In the present description, only typical 

25 parameters that are adequate for understanding the present 
invention will be exemplified rather than enumerating all 
constituent parameters of normal gait parameters. 
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Returning to the explanation of Fig. 9, the 
procedure then proceeds to S024 to calculate an initial 
state of the normal gait. The initial state calculated 
here includes the initial body horizontal position/velocity 
5 (the initial body position and the initial body velocity in 

the horizontal direction) , the initial body vertical 
position/velocity (the initial body position and the 
initial body velocity in the vertical direction) , an 
initial divergence component, and the initial body posture 

10 angle and the angular velocity thereof of the normal gait. 
The calculation of the initial state is carried out by 
search processing according to the flowchart of the 
subroutine processing shown in Fig. 11. The initial state 
of the normal gait finally determined by the processing of 

15 Fig. 11 is the state at the time of the terminating end of 
the current time's gait (the original initial time 0 of the 
normal gait); however, in the present embodiment, the state 
at the initial time Ts set in S112 of Fig. 10 is taken as 
the initial state of the normal gait until the processing 

20 of S2008 of Fig. 11 is completed. 

The following will explain the subroutine 
processing of Fig. 11. First, in S2000, the parameter 
values of a second turning gait parameter (the gait 
parameter that specifies the second turning gait) that 

25 includes an initial (time Ts) body position Xs and a 

changing velocity Vxs thereof, an initial (time Ts) body 
posture angular velocity cobs, and a body inclination 
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restoring moment ZMP-converted value peak value ZMPrecpeek, 
which have been finally determined by the processing of 
S022 and S024 when the last time's gait (the gait that is 
one step before the current time's gait) was generated, are 
5 defined as the provisional values of the parameters of the 
first turning gait parameter of the normal turning gait 
associated with the current time's gait. 

The aforesaid body inclination restoring moment 
ZMP-converted value peak value ZMPrecpeek indicates the 

10 peak value of the ZMP-converted value ZMPrec (the amount of 
deviation from a reference desired ZMP (the desired ZMP 
defined by the ZMP trajectory parameters determined in 
S022) ) of the floor reaction force moment required for 
bringing the body posture close to a reference body posture 

15 in the one-leg supporting period of the robot 1 (more 

specifically, the period from the moment immediately after 
the one-leg supporting period begins to the moment 
immediately before it ends. Hereinafter, it will be 
referred to as the body inclination angle restoring period 

20 in some cases), an example thereof being shown in Fig. 20. 

As shown in the figure, ZMPrec is shown in the trapezoidal 
patterns, the peak values (the heights of the trapezoids) 
being denoted by ZMPrecpeek. 

In S2000, the parameter values of the first turning 

25 gait parameter (the parameter specifying the first turning 
gait) finally determined by the processing of S022 and S024 
when generating the last time's gait are defined as the 
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provisional values of the parameters of the second turning 
gait parameter of the normal turning gait associated with 
the current time's gait. The initial state of the body 3 
in the normal turning gait associated with the last time's 
5 gait has been included in the turning gait parameter 

because, in the present embodiment, the initial time Ts for 
generating the normal turning gait for one cycle differs 
from the original initial time 0, whereas the initial state 
of the body 3 at the original initial time 0 is the same as 

10 the state of the body 3 at time in the middle of the second 
turning gait. The above is the processing of S2000. 

The processing of S2000 means that the candidates 
of the first turning gait parameter and the second turning 
gait parameter of the normal turning gait associated with 

15 the current time's gait are temporarily made to agree with 
the second turning gait parameter and the first turning 
gait parameter, respectively, of the normal turning gait 
associated with the last time's gait. If a normal turning 
gait is generated using the aforesaid dynamic models on the 

20 basis of the normal turning gait parameter composed of the 
first turning gait parameter and the second turning gait 
parameter associated with the current time's gait that has 
been set as described above, then the normal turning gait 
will satisfy the boundary condition of the normal turning 

25 gait. Incidentally, the normal turning gait parameter 

composed of the first turning gait parameter and the second 
turning gait parameter associated with the current time's 
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gait set as described above corresponds to the base normal 
gait parameter in the second invention. Thus, the 
processing of S2000 corresponds to the base normal gait 
parameter setting means in the second invention. 
5 Subsequently, in S2000-1, the values of the 

priority parameters of the normal gait parameter excluding 
the initial (Ts) body horizontal position Xs, the initial 
(Ts) body horizontal velocity, the initial (Ts) body 
posture angular velocity obs, and the body inclination 

10 restoring moment converted value ZMPrecpeek, which are 
search objects (search object parameters), (more 
specifically, the foot trajectory parameter, the reference 
body posture trajectory parameter, the arm posture 
trajectory parameter, the floor reaction force vertical 

15 component trajectory parameter, the parameter defining a 

floor reaction force horizontal component permissible range, 
and the ZMP trajectory parameter of the normal gait 
determined in S022), are updated to the values that have 
been brought closer, by predetermined amounts, to the 

20 values determined in the aforesaid S022 from current 
candidate values (the values set in S2000) . 

Subsequently, in S2004-1, the values of search 
objects Xs, Vxs, cobs, and ZMPrecpeek that satisfy the 
boundary condition of a normal gait are determined in the 

25 exploratory manner on the basis of the normal gait 
parameters of the current candidates (the priority 
parameters of the normal gait parameter provisionally 
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determined in S2000 that have been updated in S2002-1) . 
This processing is carried out as shown by the flowchart 
shown in Fig. 12. In the following explanation of the 
processing (including the subroutine processing in the 
5 processing) of Fig. 12, "the current value" related to the 
value of each parameter of the gait parameter will be used 
to mean "the candidate value or the provisional value 
currently (at the point of time when the appropriate 
processing is being carried out) set" of an appropriate 
10 parameter. Further, "current xx" (xx denotes a parameter) 

will be used to mean "xx that is a current (at the point of 
time when the appropriate processing is being carried out) 
candidate . " 

The processing of Fig. 12 will now be explained. 

15 First, in S1200, the initial states (the states at the 
initial time Ts of the normal turning gait) of foot 
positions/postures, a body posture angle 0bs, and the arm 
postures are determined on the basis of a current normal 
turning gait parameter. These initial states are the 

20 states observed in the supporting leg coordinate system 

(the aforesaid next time's gait supporting leg coordinate 
system) of the first turning gait. In this processing, the 
initial states of the foot positions/postures are 
determined to be the positions/postures of the feet 22 at 

25 time Ts in the foot position/posture trajectory calculated 
using a finite-duration setting filter on the basis of the 
foot trajectory parameter of a current normal gait 
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parameter. The finite-duration setting filter is explained 
in the aforesaid publication document 1 and the like, so 
that the explanation thereof will be omitted herein. The 
initial state of the body posture angle 0bs is determined 
5 to be identical to the reference body posture angle at time 
Ts decided from the reference body posture trajectory 
parameter of the current normal gait parameter, and the 
initial state of the arm postures are determined to be 
identical to the state at time Ts decided by the arm 
10 posture trajectory parameter of the current normal gait 
parameter . 

Subsequently, in S1202, the current values of the 
initial (time Ts) body horizontal position, the initial 
body horizontal velocity, the initial body posture angular 

15 velocity, and the body inclination restoring moment ZMP- 
converted value peak value (Xsl, Vxl, cobsl, and 
ZMPrecpeekl) , which are search objects, are taken as the 
initial candidates of the search objects. The values of 
these search objects are the values observed in the 

20 supporting leg coordinate system (the aforesaid next time's 
gait supporting leg coordinate system) of the first turning 
gait . 

Subsequently, the loop processing of S1206 to S1218 
is carried out. To schematically explain the processing, a 
25 gait up to the terminating end (time Ts+Tcyc) of a normal 

gait is generated using the normal gait parameter including 
the initial candidates of the search objects set as 
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described above and the aforesaid dynamic model. Then, it 
is determined whether the generated normal gait satisfies 
the boundary condition (the condition in that the states 
(the body horizontal position, the body horizontal velocity, 
5 the body posture angle, and the body posture angular 

velocity in the present embodiment) at the beginning and 
the end substantially agree) , and if it does not satisfy 
the boundary condition, then the values of the search 
objects are changed. This is repeated so as to finally 

10 determine the initial states of the normal gait that can 
satisfy the boundary condition of the normal gait on the 
dynamic model. 

The following will explain .the processing of S1202 
to S1218 more specifically. In S1202, the body vertical 

15 position and the body vertical velocity (Zs, Vzs) at the 
beginning (time Ts) of a normal gait on the dynamic model 
are determined. In this case, they are determined such 
that the resultant force of the inertial force in the 
vertical direction of the total center-of -gravity of the 

20 robot 1 and gravity on the dynamic model balances out a 
desired floor reaction force vertical component, and the 
vertical position of the total center-of -gravity satisfies 
the boundary condition of the normal gait. This processing 
is carried out in the same manner as that of the processing 

25 of S206 shown in Fig. 20 in the aforesaid publication 

document 1. Incidentally, (Zs, Vzs) depend upon Xs, Vxs, 
9bs, and cos. Hence, (Zs, Vzs) have attributes as 
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subordinate search object parameters. 

Subsequently, in S1208, a normal gait is generated 
using a dynamic model up to the time Ts+Tcyc (the 
terminating end of the normal gait) on the basis of the 
5 normal gait parameter that includes the current values of 
the initial states (9bs, Xs, Vxs, cobs, Zs, and Vzs) of the 
body 3 and the current value of ZMPrecpeek. This 
processing is executed by the subroutine processing shown 
by the flowchart of Fig. 13, and further, the processing of 

10 S304 of this Fig. 13 is executed by the subroutine 

processing shown by the flowchart of Fig. 14. Further, the 
processing of S412 of Fig. 14 is executed by the subroutine 
processing shown by the flowchart of Fig. 15. These 
processing will be described hereinafter. 

15 Subsequently, in S1210, the body horizontal 

position, the body horizontal velocity, and the body 
posture angle and the angular velocity thereof at the 
terminating end of the normal gait generated in S1208 are 
converted into the values observed from the supporting leg 

20 coordinate system of the next one step of the normal gait 
(the supporting leg coordinate system of the first turning 
gait following the second turning gait of the normal gait) , 
and the obtained values are denoted as (Xel, Vxel, 9bel, 
cobel) . 

25 Then, in S1212, the differences between the values 

of the current (Xsl, Vxsl, 0bsl, obsl) and the values of 
(Xel, Vxel, Gbel, (Dbel) are determined as boundary 
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condition errors (errx, errv, errG, errco) of the normal 
gait. To satisfy the boundary condition of the normal gait, 
the boundary condition error must be substantially zero. 
The boundary condition error indicates the degree of 
5 deviation of the normal gait created in S1208 from the 
boundary condition. 

Subsequently, in S1214, it is determined whether 
all of errx, errv, errG, and errco fall within a 
sufficiently small (in the vicinity of zero) predetermined 

10 permissible range, and if the determination result is YES, 
then the loop processing of S1206 to S1218 is terminated. 
In this case, the normal gait parameter at the completion 
of the loop processing is obtained as the normal gait 
parameter that allows the boundary condition to be 

15 satisfied on the dynamic model. 

Meanwhile, if the determination result of S1214 is 
NO, then the candidates of a plurality of (four in the 
present embodiment) search objects obtained by changing the 
values of the individual parameters by predetermined 

2 0 extremely small amounts AXs, AVx, Acobs, and AZMPrecpeek 

are determined in the vicinity of the values of the current 
search objects (Xs, Vx, cobs, ZMPrecpeek) , and the same 
processing as that of S1206 to S1212 is carried out to 
determine the boundary condition errors corresponding to 

25 the candidates of the individual search objects on the 
basis of the normal gait parameter that includes the 
candidates of the individual search objects (the normal 
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gait parameter having the search objects of the current 
normal gait parameter corrected to the newly determined 
candidates) . 

Subsequently, in S1218, the new candidates of the 
5 search objects (Xs, Vx, cobs, ZMPrecpeek) are determined by 
a search technique, such as the steepest descent method or 
the simplex method, on the basis of the current (Xs, Vx, 
cobs, ZMPrecpeek) and the boundary condition errors 
corresponding to the individual candidates of the search 

10 objects in the vicinity thereof. Then, the processing from 
S1206 is repeated again. 

As described above, with the (Xs, Vx, cobs, 
ZMPrecpeek) as the search objects, a normal gait parameter 
that satisfies the boundary condition of the normal gait is 

15 determined in the exploratory manner. Incidentally, in the 
processing of Fig. 12, the priority parameters (the foot 
trajectory parameter, the reference body posture trajectory 
parameter, and the like) out of the normal gait parameter 
are maintained at the values at the start of the processing 

20 shown in Fig. 12. 

Supplementally, the basic concept (technique) of 
the processing of Fig. 12 is the same as that of the 
processing of Fig. 20 in the aforesaid publication document 
1. However, in the embodiments in the present description, 
25 the aforesaid search objects include a body posture angular 
velocity and the peak value of a body inclination restoring 
moment ZMP-converted value, which is different from the 
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processing of Fig. 20 of the aforesaid publication document 
1. Further, a part of the detailed processing (subroutine 
processing) of the processing of S1208, which will be 
discussed later, is also different from the processing in 
5 the aforesaid publication document 1. 

The subroutine processing of the aforesaid S1208 
will be explained below. 

The processing of Fig. 13, which is the subroutine 
processing of S1208, is, as shown in the figure, the 

10 processing in which the current values (the candidate 

values or the provisionally determined values) of (Xs, Vxs, 
Gbs, cobs, Zs, and Vzs) are defined as the initial state of 
a motion of the body 3 in a normal gait (S300) and the 
instantaneous values of the normal gait from the initial 

15 (time Ts) state to time Ts+Tcyc (to a terminating end 

state) are actually created in time series (S302 to S306) . 
Incidentally, "k" in Fig. 13 denotes the time of the time 
series of the instantaneous values of the normal gait to be 
created. 

20 The processing of Fig. 14, which is the subroutine 

processing of S304 in Fig. 13 (the subroutine processing 
for determining the instantaneous values of a normal gait) , 
determines the instantaneous values of a desired floor 
reaction force vertical component, a desired ZMP, desired 

25 positions/postures of both feet, a reference body posture, 
a desired arm posture, a desired body vertical position, 
and a floor reaction force horizontal component permissible 
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range by the processing of S400 to S410 on the basis of a 
current normal gait parameter (to be specific, priority 
parameters) . 

Further, the processing of S412 determines the 
5 instantaneous values of a body horizontal acceleration and 
a body posture angular acceleration by using a dynamic 
model such that the conditions described in the figure are 
satisfied. Then, the processing of S414 subjects the body 
horizontal acceleration and the body posture angular 

10 acceleration to the second-order integration so as to 

determine the instantaneous values of the body horizontal 
position and the body posture angle. 

Supplementally, of the processing shown in Fig. 14, 
the processing other than S412 is the same as the 

15 processing of S400 to S410 and S414 of Fig. 22 in the 
aforesaid publication document 1. Hence, a detailed 
explanation of the processing shown in Fig. 13 except for 
the processing of S412 will be omitted. 

In the processing of Fig. 15, which is the 

20 subroutine processing of S412 in Fig. 14, first, times Tm, 
Ts2, and Tm2 that define body inclination angle restoring 
periods of a normal gait are determined. These times 
individually define the period during which the aforesaid 
body inclination restoring moment ZMP-converted value 

25 ZMPrec is generated, as shown in Fig. 20. More 

specifically, the time immediately after a first one-leg 
supporting period begins following the initial time Ts of a 
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normal gait is denoted by Tm, the time immediately before 
the one-leg supporting period ends is denoted by Ts2, and 
the time immediately after the next one-leg supporting 
period begins is denoted by Tm2 in determining the above 
5 times. And, a period [Tm,Ts2] and a period [Tm2,Te] are 
individually defined as the periods for generating ZMPrec 
(hereinafter referred to as the body inclination angle 
restoring period) . This is the same as the processing of 
S500 in Fig. 23 in the aforesaid publication document 1. 

10 Subsequently, in S502, it is determined whether 

current time k at which an instantaneous value of a normal 
gait is to be created (time within a normal gait that is 
being created) is within a body inclination angle restoring 
period. And, if the current time k is not time within the 

15 aforesaid body inclination angle restoring period, i.e., if 
the current time k is within the period from the moment 
immediately before the end of a one-leg supporting period 
to the moment immediately after the next one-leg supporting 
period begins (the period during which a desired floor 

20 reaction force vertical component is zero or close to zero) , 
then the processing of S504 to S516 determines a body 
horizontal acceleration a of the body translational mode 
and a body angular acceleration p (the angular acceleration 
of a body posture angle) of the body rotation mode such 

25 that a desired ZMP is satisfied on the dynamic model and 

the floor reaction force horizontal component that balances 
out the inertial force attributable to a horizontal 
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acceleration of the total center-of -gravity of the robot 1 
on the dynamic model falls within an instantaneous value of 
a floor reaction force horizontal component permissible 
range at time k. The processing of S504 to S516 is the 
5 same as the processing of S504 to S516 in Fig. 19 in the 
aforesaid publication document 1. 

Further, if the current time k (the time in a 
normal gait that is being created) is time within the 
aforesaid body inclination angle restoring period, then the 

10 body angular acceleration P is determined by the processing 
of S518 to S526 such that a floor reaction force moment 
based on the instantaneous value of a body inclination 
restoring moment ZMP-converted value pattern (This depends 
on a currently set body inclination restoring moment ZMP- 

15 converted value peak value (a candidate value determined 

immediately before the processing of S1208 of Fig. 12) and 
the current time k. Refer to Fig. 20) is generated about a 
desired ZMP on the dynamic model. Further, the body 
horizontal acceleration is determined as the difference 

20 between a body horizontal acceleration for the floor 

reaction force moment about a desired ZMP generated by the 
body translational mode to become zero and a body 
horizontal acceleration that generates a floor reaction 
force moment equivalent to the floor reaction force moment 

25 about a desired ZMP attributable to the body angular 
acceleration p on the dynamic model. Thus, the body 
angular acceleration p and the body horizontal acceleration 



a are determined such that a desired ZMP is satisfied 
while restoring a body posture toward the reference body 
posture in the body inclination angle restoring period. 

Supplementally, the processing of S518 to S526 of 
Fig. 15 in the present embodiment is the same as the 
processing of S520 to S528 of Fig. 23 in the aforesaid 
publication document 1. 

The processing of S2002-1 and 2004-1 of Fig. 11 
explained above is briefly said to be the processing in 
which the value of a priority parameter (a foot trajectory 
parameter or the like) of a normal gait parameter is 
updated by bringing it closer, by a predetermined amount, 
to a value determined by the processing of S022 
(specifically, the processing of S100 to S110 of Fig. 10) 
from a current value (a current candidate value), and a new 
normal gait parameter that includes the updated priority 
parameter and that is capable of satisfying a boundary 
condition of a normal gait on a dynamic model is searched 
for. And, in this processing, (Xs, Vx, cobs, ZMPrecpeek) 
are set as the search objects. Incidentally, the current 
value (the candidate value before the update) of the 
priority parameter of the normal gait parameter in S2002-1 
is the value of the priority parameter out of the 
provisional value of the normal gait parameter determined 
in S2000. Further, in the processing of S2004-1, the 
provisional values determined in S2000 are used as the 
initial candidate values of the search objects. 
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Returning to the explanation of Fig. 11, after the 
aforesaid processing of S2002-1 and S2004-1, the same 
processing (S2002-2 and S2004-2 in Fig. 11) as the 
processing of S2002-1 and S2004-1 is repeated. Then, 
5 lastly, in S2004-n (n denotes the total number of 

repetitions) , the priority parameter of the normal gait 
parameter is made to agree with the value determined by the 
processing of S022. Further, in S2004-n, as with S2004-1, 
based on a current candidate normal gait parameter, the 

10 values of the search objects Xs, Vx, cobs, and ZMPrecpeek 

that satisfy the boundary condition of the normal gait are 
determined in the exploratory manner on the dynamic model, 
thus determining a new normal gait parameter. 

In the repeated processing, the value of a priority 

15 parameter before the priority parameter is updated in 

S2002-k (k=2,...,n) is the value of the priority parameter 
after the update in S2002-(k-l) (in S2002-1, the value of 
the priority parameter before an update is the provisional 
value determined in S2000, as described above) . The 

20 processing of S2004-k ( k=2 , ... , n) is the same as the 

processing of S2004-1. In S2004-k, however, the values 
that have been set at the start of the processing of S2004- 
k, i.e., the values of the search objects that have finally 
been searched for by the processing of S2004-(k-l), are 

25 used as the initial value candidates (the initial value 

candidates set in S1202 of Fig. 12) of the search objects 
Xs, Vx, cobs, and ZMPrecpeek (in S2004-1, the initial value 
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candidates of the search objects are the provisional values 
determined in S2000, as described above) . 

As described above, using the values (provisional 
values) of the priority parameters of the normal gait 

5 parameter determined in S2000 as initial values, the value 
of the priority parameter is updated in steps such that the 
value of the priority parameter approaches in steps the 
value determined by the processing of S022 (this is the 
value of the priority parameter for satisfying a 

0 requirement related to a current time's gait (the required 
value of the priority parameter) ) until it finally made to 
agree with the value determined by the processing of S022 

(S2002-1, S2002-2, , and S2002-n) . Accordingly, the 

processing of these S2002-1, S2002-2, , and S2002-n 

5 corresponds to the- priority parameter asymptotic means in 
the second invention. And, each time the priority 
parameter is updated, the values of the search objects of 
the normal gait parameter including the updated priority 
parameter are searched for, using the values determined 

0 immediately before the update as the initial value 

candidates, such that the boundary condition of the normal 
gait is satisfied, and a normal gait parameter that 
includes the search objects as the search result is newly 
determined (S2004-1, 2004-2, , and S2004-n) . 

5 Accordingly, the processing of these S2004-1, 2004-2, , 

and S2004-n corresponds to the new normal gait parameter 
determining means in the second invention, and a normal 
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gait parameter including search objects finally determined 
in each processing corresponds to the new normal gait 
parameter in the second invention. And, the new normal 
gait parameter finally determined in S2004-n will be the 
5 gait parameter of the normal gait to follow the current 
time's gait to be generated. 

Supplementally, the total number n of repetitions 
of the aforesaid repetitive processing is determined on the 
basis of the difference between the value of the priority 

10 parameter of the normal gait parameter determined in S2000 
and the value of the priority parameter determined in S022 
(a priority parameter required value) . Of the normal gait 
parameter, the parameters (fixed parameters) other than 
priority parameters and search object parameters are 

15 maintained at the values of the appropriate parameters of 
the normal gait parameter determined in S2000. 

After the repetitive processing of S2002-1 to 
S2004-n is executed as described above, an initial body 
horizontal position X0, an initial body horizontal velocity 

20 VxO, an initial body posture angle GbO and the angular 

velocity cobO thereof, an initial body vertical position Z0, 
and an initial body vertical velocity VzO, which constitute 
the motion state of the body 3 of the normal gait at the 
original initial time 0, are determined on the basis of a 

25 current candidate normal turning gait (the normal gait 
lastly created in the processing of S2004-n) in S2006. 
Further, in S2008, a normal turning initial divergence 
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component q[0], which is a divergence component at the 
original initial time 0, of the normal turning gait is 
determined according to the definitional equation of the 
aforesaid initial divergence component q. The values 
5 determined in S2006 and S2008 are the values observed in 
the supporting leg coordinate system of the first turning 
gait of the normal turning gait following the current 
time's gait. Then, in S2010, q", which is the value of the 
normal turning initial divergence component q[0] observed 

10 from the supporting leg coordinate system of the current 
time's gait, and (Z0",Vz0"), which are the values of the 
initial body vertical position/velocity observed from the 
supporting leg coordinate system of the current time's gait, 
are determined. 

15 The above is the detailed explanation of the 

processing of Fig. 11. 

The processing of Fig. 11 explained above updates 
the values of the priority parameters of a provisional 
normal gait parameter (the normal gait parameter determined 

20 in the past such that a boundary condition of a normal gait 
is satisfied) determined in S2000 so as to gradually bring 
the values close to the values of the priority parameters 
determined in S022 (the priority parameters of a normal 
gait to follow a current time's gait to be generated), and 

25 each time the values are updated, a normal gait parameter 

that satisfies the boundary condition of the normal gait is 
newly determined. This makes it possible to efficiently 
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and promptly create a normal gait that allows a boundary 
condition of a normal gait to be satisfied without causing 
body position/posture to develop divergences, thus 
permitting an initial state of a normal gait for a current 

5 time's gait to be properly determined. 

Returning to the explanation of Fig. 9, after the 
processing of S024 is carried out as explained above, the 
gait parameter of the current time's gait is determined 
(some are provisionally determined) in S026. This 

0 processing is carried out according to the flowchart of Fig. 
16. The gait parameter determined here includes the 
parameters that specify the foot position/posture 
trajectories (the position/posture trajectories of the feet 
22), a reference body posture trajectory, an arm posture 

5 trajectory, a floor reaction force vertical component 

trajectory, a floor reaction force horizontal component 
permissible range, and a ZMP trajectory, respectively, in 
the current time's gait, these parameters being determined 
by the processing of S600 to S610. Then, in S612, the body 

0 inclination angle restoring period [Ta,Tb] in the current 
time's gait is set. These processing is the same as the 
processing of the flowchart of Fig. 33 in the aforesaid 
publication document 1, so that no detailed explanation 
will be given herein, but the parameters that define the 

5 trajectories are determined such that the aforesaid 

trajectories connect to a normal gait from the state at the 
terminating end of the last time's gait (= the initial 
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state of the current time's gait) while satisfying the 
aforesaid requirements related to the current time's gait. 
For example, the foot trajectory parameter related to the 
free leg foot 22 of the current time's gait is determined 
5 such that the estimated landing position/posture and time 
of the free leg foot 22 of the current time' s gait satisfy 
those required values and, at the terminating end of the 
current time's gait, the position/posture of the free leg 
foot 22 agree at the beginning of the normal gait (the time 

10 of the terminating end of the current time's gait). 

Supplementally, the ZMP trajectory parameter 
determined in S610 is a parameter that defines the ZMP 
trajectory (a provisional desired ZMP trajectory) providing 
the reference for the current time's gait, an example of 

15 the provisional ZMP trajectory defined by the parameter (an 
example of the trajectory in the X-axis direction) being 
shown at the top in Fig. 22. The ZMP trajectory parameter 
is determined such that a desired ZMP is positioned near 
the substantially center of the ground contact surface of 

20 the supporting leg foot 22 in the one-leg supporting period 
of the current time's gait and the desired ZMP continuously 
changes up to the initial ZMP of the normal gait at the 
terminating end of the current time' s gait in the floating 
period following the one-leg supporting period. The body 

25 inclination angle restoring period set in S612 of Fig. 16 
is the period from time Ta to time Tb in Fig. 22, which is 
the period from the moment immediately after the start of 
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the one-leg supporting period of the current time's gait to 
the moment immediately before the end thereof. 

Supplementally, the parameters of the current 
time's gait determined by the processing from S600 to S610 
5 are the parameters determined to preferentially satisfy the 
requirements related to the current time's gait, so that 
the parameters of the current time's gait determined by the 
processing of the aforesaid S600 to S610 correspond to the 
priority parameters in the aforesaid first invention, and 

10 the determined values correspond to priority parameter 

required values. Accordingly, the processing of S600 to 
S610 corresponds to the priority parameter required value 
determining means in the first invention. Further, the 
parameters of the current time's gait determined by the 

15 processing of S600 to S610 are not all parameters 

constituting the current time's gait parameter. As with 
the case of a normal gait parameter, the gait parameter of 
the current time's gait includes a variety of parameters in 
addition to the above parameters. In the present 

20 embodiment, the parameters constituting the current time's 
gait parameter include, for example, a ZMP correction 
parameter defining the ZMP correction amount for correcting 
a ZMP trajectory parameter and the peak value of a body 
inclination restoring moment ZMP-converted value (two types 

25 of peak values in this case) in addition to the parameters 
(priority parameters) determined in S600 to S610. These 
parameters are the parameters determined in an exploratory 
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manner in the processing of S028 explained below such that 
the boundary condition of a current time's gait (a 
condition for approaching a normal gait) is satisfied. 

As with the case of a normal gait parameter, the 
5 parameters constituting a current time's gait parameter are 
roughly divided into the aforesaid priority parameters and 
the remaining non-priority parameters. The non-priority 
parameters include the parameters determined in the 
exploratory manner as described above (the search object 

10 parameters in the aforesaid first invention) . The non- 
priority parameters include fixed parameters not depending 
upon the requirements related to gaits or the boundary 
conditions related to gaits (e.g., the lifting height of 
the free leg foot 22 of the robot 1) . Furthermore, there 

15 are lower parameters that are subordinately determined from 
a single or a plurality of upper parameters. In this case, 
the attributes of lower parameters are the same as in the 
case of normal gait parameters. 

The procedure proceeds to S028 in Fig. 9 to correct 

20 the gait parameter (the ZMP trajectory parameter) of the 

current time's gait (to determine the final current time's 
gait parameter) . In this processing, the gait parameter of 
the current time's gait is corrected such that the 
divergence component at the terminating end of the current 

25 time's gait agrees with the initial divergence component q" 
of the normal turning gait determined in S024 (more 
specifically, such that the body position/posture 
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trajectory connects or approximates to the normal gait) , 
thus determining the final current time's gait parameter 
(more specifically, the ZMP correction parameter and the 
two types of peak values of the body inclination restoring 
5 moment ZMP-converted values are determined) . In the 
present embodiment, as described above, the boundary 
condition at the terminating end of the current time' s gait 
is such that the divergence component at the terminating 
end of the current time's gait agrees (or substantially 

10 agrees) with the initial divergence component q" of the 
normal turning gait. 

This processing is carried out by step-by-step 
exploratory processing that uses the subroutine processing 
indicated by the flowchart shown in Fig. 17. 

15 The following will explain the subroutine 

processing of Fig. 17. First, in S2100, the parameter 
values of the current time's gait parameter that include 
the ZMP corrected parameter "a" finally determined by the 
processing of S026 and S028 when the last time's gait was 

20 generated and the first peak value ZMPrecpeeka and the 

second peak value ZMPrecpeekb, which are body inclination 
restoring moment converted values, are defined as the 
provisional values of the parameters of the current time's 
gait parameter to be generated. However, the gait 

25 parameter of the last time's gait is laterally reversed 

when taking the parameter values as the provisional values 
of the parameters of the current time's gait. For example, 
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the provisional values of the foot trajectory parameter of 
a supporting leg, the foot trajectory parameter of a free 
leg, and a ZMP trajectory parameter of the current time's 
gait are set to be the ones obtained by laterally reversing 
5 these parameters of the last time's gait. 

Here, the first peak value ZMPrecpeeka and the 
second peak value ZMPrecpeekb of a body inclination 
restoring moment ZMP-converted value obtained (searched 
for) in the processing of the flowchart of Fig. 17 are 

10 search object parameters indicating the two peak values of 
the pattern of the ZMP-converted value of a floor reaction 
force moment required to bring a body posture close to a 
reference body posture during the body inclination angle 
restoring period [Ta,Tb] of the current time's gait, an 

15 example thereof being shown in Fig. 21. The number of peak 
values of the body inclination restoring moment ZMP- 
converted value has been one in the case of a normal gait; 
in the present embodiment, however, the first peak value 
ZMPrecpeeka and the second peak value ZMPrecpeekb are used 

20 as the two adjustable parameters of a body inclination 

restoring moment ZMP-converted value so as to make the body 
posture angle and the angular velocity thereof at the 
terminating end of the current time's gait coincide with 
the initial body posture angle and the angular velocity 

25 thereof, respectively, of the normal gait. In the present 
embodiment, as shown in Fig. 21, the body inclination 
restoring moment ZMP-converted value in the current time's 
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gait has a pattern combining a trapezoidal pattern in the 
first half and another trapezoidal pattern in the latter 
half of the one-leg supporting period. The peak value of 
the trapezoidal pattern in the first half is the first peak 
5 value ZMPrecpeeka, and the peak value of the trapezoidal 
pattern in the latter half is the second peak value 
ZMPrecpeekb. 

Further, the ZMP correction parameter "a" 
determined in the processing of the flowchart shown in Fig. 

10 17 is the parameter for specifying the correction amount of 
a desired ZMP to connect a current time's gait to a normal 
gait (to make the divergence component at the terminating 
end of a current time' s gait substantially agree with the 
initial divergence component q" of a normal gait) , an 

15 example thereof being shown at the middle in Fig. 22. As 
illustrated, the ZMP correction amount has a trapezoidal 
pattern generated from the moment immediately after the 
start to the moment immediately before the end of the one- 
leg supporting period, and the peak value "a" is used as 

20 the ZMP correction parameter that defines the pattern of 
the ZMP correction amount. 

The processing of S2100 explained above means that 
the gait parameter obtained by laterally reversing the last 
time's gait (this has already been determined so as to 

25 satisfy the boundary condition of a gait) is set as the 
gait parameter of the current time's gait for the time 
being. If a current time's gait is generated using the 
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aforesaid dynamic model on the basis of the current time's 
gait parameter thus set, the current time's gait will agree 
with the one obtained by laterally reversing the last 
time's gait already determined to satisfy the boundary 
5 condition of the gait. Incidentally, the current time's 
gait parameter set as described above corresponds to the 
base gait parameter in the first invention. Accordingly, 
the processing of S2100 corresponds to the base gait 
parameter setting means in the first invention. 

10 Supplementally, if the current time's gait is 

composed of a gait for two steps of the robot 1, then the 
gait parameter of the last time's gait (the gait that is 
two steps before) may be directly set as the provisional 
value of the gait parameter of the current time' s gait in 

15 S2100 without performing the lateral reversal. 

Alternatively, the provisional value of the gait parameter 
of the current time's gait may be set to the gait parameter 
of the last but one gait. 

Subsequently, in S2102-1, the values of the 

20 priority parameters of the current time's gait parameter 
excluding the ZMP corrected parameter "a" and the first 
peak value ZMPrecpeeka and the second peak value 
ZMPrecpeekb of the body posture inclination restoring 
moment ZMP-converted value, which are search objects 

25 (search object parameters), (more specifically, the foot 

trajectory parameter, the reference body posture trajectory 
parameter, the arm posture trajectory parameter, the floor 
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reaction force vertical component trajectory parameter, the 
parameter defining a floor reaction force horizontal 
component permissible range, and the ZMP trajectory 
parameter of the current time's gait determined in S026) 
5 are updated to the values that have been brought closer, by 
predetermined amounts, to the values determined in the 
aforesaid S026 from current candidate values (the values 
set in S2100) . 

Subsequently, in S2104-1, the values of search 

10 objects "a", ZMPrecpeeka, and ZMPrecpeekb that satisfy the 
aforesaid boundary condition (a condition in that the 
divergence component at the terminating end of a current 
time's gait agrees or substantially agrees with the 
divergence component at the beginning of a normal gait) of 

15 the current time' s gait are determined in the exploratory 

manner on the basis of the current time's gait parameter of 
the current candidate (the priority parameters of the 
normal gait parameter provisionally determined in S2100 
that have been updated in S2102-1) . This processing is 

20 carried out as shown by the flowchart shown in Fig. 18. 
Incidentally, as in the case of the explanation of the 
processing of the aforesaid Fig. 12, the following 
explanation of the processing (including the subroutine 
processing in the processing) of Fig. 18, "the current 

25 value" related to the value of each parameter of the gait 
parameter will be used to mean "the candidate value or the 
provisional value currently (at the point of time when the 
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appropriate processing is being carried out) set" of an 
appropriate parameter. Further, "current xx" (xx denoting 
a parameter) will be used to mean "xx that is a current (at 
the point of time when the appropriate processing is being 
5 carried out) candidate. " 

The processing of Fig. 18 will now be explained. 
First, in S1700, the current values of the ZMP correction 
parameter and the first peak value and the second peak 
value of the body inclination restoring moment ZMP- 

10 converted value ("a", ZMPrecpeeka, and ZMPrecpeekb) , which 
are search objects, are set as the initial value candidates 
of these search objects. 

Subsequently, the loop processing of S1704 to S1716 
is carried out. The processing will be schematically 

15 explained. First, in S1704, a current time's gait (a 

provisional current time's gait) is calculated using the 
current values (current candidate values) of the "a", 
ZMPrecpeeka, and ZMPrecpeekb, which are the search objects, 
and the aforesaid dynamic model. More specifically, a 

20 provisional current time' s gait is calculated using the 
current time's gait parameter that includes the current 
values of the search objects, namely, "a", ZMPrecpeeka, and 
ZMPrecpeekb, and the current values of priority parameters, 
and the dynamic model. More specific processing of S1704 

25 will be discussed hereinafter. 

Then, in S1706 to S1716, the difference between the 
divergence component at the terminating end of the 
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provisional current time's gait (the estimated landing time 
of a free leg foot of the current time's gait) calculated 
in S1704 and the initial divergence component q" of the 
normal gait (lastly calculated in the aforesaid S024), the 
5 difference between the body posture angle at the 

terminating end of the provisional current time's gait and 
the initial body posture angle of the normal gait (lastly 
calculated in the aforesaid S024), and the difference 
between the angular velocity of the body posture angle at 

10 the terminating end of the provisional current time's gait 
and the initial body posture angular velocity of the normal 
gait (lastly calculated in the aforesaid S024) are 
determined. Then, it is determined whether all the values 
of these differences satisfy a condition in that they fall 

15 within permissible ranges (whether they approximate zero) , 
and if they do not satisfy the condition, then the values 
of the search objects are changed. This is repeated to 
finally determine anew a current time's gait parameter that 
includes "a", ZMPrecpeeka, and ZMPrecpeekb as the corrected 

20 values of the parameters of the search objects that allows 
the provisional current time's gait to connect to the 
normal gait on the dynamic model. 

The processing of S1706 to S1706 will be explained 
more specifically. In S1706, the divergence component 

25 q0[k] at the terminating end of the current time's gait is 
calculated from the body position/velocity (Xe, Ve) at the 
terminating end of the provisional current time's gait 
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according to the definitional equation of divergence 
components described above. 

Subsequently, in S1708, the difference between the 
divergence component q0[k] at the terminating end and the 
5 initial divergence component q" of the normal turning gait 

is determined as a terminal divergence component error errq. 

Further, in S1710, the difference between the 
initial body posture angle of the normal gait and the 
terminal body posture angle of the current time' s gait 

10 (provisional current time's gait) is determined as the 

terminal body posture angle error Gberr, and the difference 
between the initial body posture angular velocity of the 
normal gait and the terminal body posture angular velocity 
of the current time's gait (provisional current time's 

15 gait) is determined as the terminal body posture angular 
velocity error toberr. 

The errors errq, Gberr, and coberr determined as 
described above indicate the degree of deviation of the 
provisional current time's gait created in S1704 from a 

20 boundary condition. 

Subsequently, in S1712, it is determined whether 
all errq, Gberr, and coberr determined as described above 
fall within a predetermined permissible range in the 
vicinity of zero, and if the determination result is YES, 

25 then the loop processing of S1704 to S1716 is terminated. 
In this case, the current time's gait parameter that 
includes the search objects at the completion of the loop 
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processing is obtained as the current time' s gait parameter 
that can satisfy the boundary condition on the dynamic 
model . 

Meanwhile, if the determination result of S1712 is 
5 NO, then the candidates of a plurality of (three in the 

present embodiment) search objects obtained by changing the 
values of the individual parameters by predetermined 
extremely small amounts Aa, AZMPrecpeeka, and AZMPrecpeekb 
are determined in the vicinity of the values of the current 

10 search objects ("a", ZMPrecpeeka, and ZMPrecpeekb) , and the 
same processing as that of S1704 to S1710 is carried out on 
the basis of the current time's gait parameter that 
includes the candidates of the individual search objects 
(the current time's gait parameter in which the search 

15 objects of the present current time's gait parameter have 
been corrected to newly determined candidates) , thereby 
determining a set of errors (errq, 0berr, and oberr) 
corresponding to the candidate of each search object. 

Subsequently, in S1716, the new candidates of the 

20 search objects ("a", ZMPrecpeeka, and ZMPrecpeekb) are 
determined by an exploratory technique, such as the 
steepest descent method or the simplex method, on the basis 
of the current ("a", ZMPrecpeeka, and ZMPrecpeekb) and the 
sets of errors (errq, 0berr, and coberr) corresponding to 

25 the individual candidates of the search objects in the 
vicinity thereof. Then, the processing from S1704 is 
repeated again. 
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As described above, with the ("a", ZMPrecpeeka, and 
ZMPrecpeekb) being the search objects, the new current 
time's gait parameter that satisfies the boundary condition 
at the terminating end of the current time's gait is 
5 determined in the exploratory manner. In the processing of 
Fig. 18, the priority parameters (e.g., a foot trajectory 
parameter and a reference body posture trajectory 
parameter) in the current time's gait parameter are 
maintained at the values observed at the start of the 

10 processing of Fig. 18. 

The processing of the aforesaid S1704 in the 
processing of Fig. 18 will be explained below. This 
processing is carried out by the subroutine processing 
shown by the flowchart of Fig. 19. As illustrated, the 

15 subroutine processing of Fig. 19 is the processing (S802 to 
S806) in which the state at the terminating end of the last 
time's gait (specifically, the terminal state of the last 
time's gait observed in the supporting leg coordinate 
system of the current time's gait) is taken as the initial 

20 state of the current time's gait (the provisional current 
time's gait) (S800) and the instantaneous values of the 
current time's gait are created in time series up to the 
terminating end time Tcurr of the current time's gait (the 
estimated landing time of the free leg foot 22 of the 

25 current time's gait) from the initial state. Incidentally, 
"k" in Fig. 19 denotes the time of the time series of the 
instantaneous values of the current time's gait to be 
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created. And, the subroutine processing of S804 in Fig. 19 
is carried out in the same manner as the processing of Fig. 
14 previously explained in relation to the processing for 
creating a normal gait. 
5 In the processing of Fig. 14 in this case, the 

processing of S400 and S404 to S410 determines the 
instantaneous values of a desired floor reaction force 
vertical component, desired positions/postures of both feet, 
a reference body posture, a desired arm posture, a desired 

10 body vertical position, and a floor reaction force 

horizontal component permissible range on the basis of the 
priority parameters of the present current time's gait 
parameter. Further, the processing of S402 in Fig. 14 
carried out in S804 of Fig. 19 determines the instantaneous 

15 values of a ZMP trajectory (refer to the bottom diagram of 
Fig. 22) obtained by correcting the desired ZMP trajectory 
by adding the ZMP correction amount specified by the 
present value (candidate value) "a" of the ZMP correction 
parameter "a" (refer to the middle diagram in Fig. 22) to 

20 the desired ZMP trajectory specified by the ZMP trajectory 
parameter of the present current time's gait parameter 
(refer to the top diagram of Fig. 22) . 

Further, the processing of S412 determines, by 
using a dynamic model, the instantaneous values of a body 

25 horizontal acceleration and a body posture angular 

acceleration such that the conditions described in the 
figure are satisfied. Then, the processing of S414 
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subjects the body horizontal acceleration and the body 
posture angular acceleration to the second-order 
integration so as to determine the instantaneous values of 
the body horizontal position and the body posture angle. 
5 Further, the processing in Fig. 15, which is the 

subroutine processing of S412 in creating a provisional 
current time's gait is also carried out in the same manner 
as that for normal gaits. More specifically, if the 
current time k at which a instantaneous value of a 

10 provisional current time's gait is to be created (time 

within the provisional current time's gait that is being 
created) is not time within the aforesaid body inclination 
angle restoring period, then the processing of S504 to S516 
determines a body horizontal acceleration a of the body 

15 translational mode and a body angular acceleration p (the 
angular acceleration of a body posture angle) of the body 
rotation mode such that a desired ZMP (the desired ZMP 
corrected by a ZMP correction amount) is satisfied and the 
floor reaction force horizontal component that balances out 

20 the inertial force attributable to a horizontal 

acceleration of the total center-of -gravity falls within an 
instantaneous value of a floor reaction force horizontal 
component permissible range at time k on the dynamic model. 
Further, if the current time k (the time in a 

25 provisional current time's gait that is being created) is 
time within the aforesaid body inclination angle restoring 
period, then the body angular acceleration P is determined 
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by the processing of S518 to S526 such that a floor 
reaction force moment corresponding to the instantaneous 
value of a body inclination restoring moment ZMP-converted 
value pattern (this depends on the current values 
5 (candidate values) of the first peak value ZMPrecpeeka and 
the second peak value ZMPrecpeekb of the body inclination 
restoring moment ZMP-converted value and the current time k. 
Refer to Fig. 21) is generated on the dynamic model. 
Further, the body horizontal acceleration is determined as 

10 the difference between a body horizontal acceleration for 
the floor reaction force moment about a desired ZMP (the 
desired ZMP corrected by a ZMP correction amount) generated 
by the body translational mode to become zero and a body 
horizontal acceleration that generates a floor reaction 

15 force moment equivalent to the floor reaction force moment 

due to the body angular acceleration P on the dynamic model. 
Thus, the body angular acceleration P and the body 
horizontal acceleration a are determined such that a 
desired ZMP is satisfied while restoring a body posture 

20 toward the reference body posture. 

The body inclination angle restoring period when a 
provisional current time's gait is generated is the period 
from time Ta to Tb determined in S612 of Fig. 16 described 
above; therefore, the processing of S500 of Fig. 15 is 

25 omitted. 

The processing of S2102-1 and 2104-1 of Fig. 17 
explained above is briefly said to be the processing in 
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which the value of a priority parameter (a foot trajectory 
parameter or the like) of a normal gait parameter is 
updated by bringing it closer, by a predetermined amount, 
to a value determined by the processing of S026 
5 (specifically, the processing of S600 to S610 of Fig. 16) 

from a current value (a current candidate value) , and a new 
current gait parameter that includes the updated priority 
parameter and that is capable of satisfying a boundary 
condition of the current time's gait on a dynamic model is 

10 searched for. And, in this processing, ("a", ZMPrecpeeka, 
ZMPrecpeekb) are set as the search objects. Incidentally, 
the current value (the candidate value before the update) 
of the priority parameter of the current gait parameter in 
S2102-1 is the value of the priority parameter out of the 

15 provisional value of the current time's gait parameter 

determined in S2100. Further, in the processing of S2104-1, 
the provisional values determined in S2100 are used as the 
initial candidate values of the search objects. 

Returning to the explanation of Fig. 17, after the 

20 aforesaid processing of S2102-1 and S2104-1, the same 
processing (S2102-2 and S2104-2 in Fig. 17) as the 
processing of S2102-1 and S2104-1 is repeated. Then, 
lastly, in S2104-n (n denotes the total number of 
repetitions), the priority parameter of the current time's 

25 gait parameter is made to agree with the value determined 
by the processing of S026. Further, in S2104-n, as with 
S2104-1, based on a current candidate current time's gait 
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parameter, the values of the search objects "a", 
ZMPrecpeeka, and ZMPrecpeekb that satisfy the boundary 
condition of the current time's gait are determined in the 
exploratory manner on the dynamic model, thus determining a 
5 new current time's gait parameter. 

In the repeated processing, the value of a priority 
parameter before the priority parameter is updated in 
S2102-k (k=2,...,n) is the value of the priority parameter 
after the update in S2102-(k-l) (in S2102-1, the value of 

10 the priority parameter before an update is the provisional 
value determined in S2100, as described above) . The 
processing of S2104-k ( k=2 , ... , n) is the same as the 
processing of S2104-1. In S2104-k, however, the values 
that have been set at the start of the processing of S2104- 

15 k, i.e., the values of the search objects that have 

finally been searched for by the processing of S2104-(k-l), 
are used as the initial value candidates (the initial value 
candidates set in S1700 of Fig. 18) of the search objects 
Xs, Vx, (Dbs, and ZMPrecpeek (in S2104-1, the initial value 

20 candidates of the search objects are the provisional values 
determined in S2100, as described above) . 

As described above, using the values (provisional 
values) of the priority parameters of the current time's 
gait parameter determined in S2100 as initial values, the 

25 values of the priority parameters are updated in steps such 
that the values of the priority parameters approach in 
steps the values determined by the processing of S026 
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(these are the values of the priority parameters for 
satisfying a requirement related to a current time's gait 
(the required values of the priority parameters) ) until 
they are finally matched with the values determined by the 

5 processing of S026 (S2102-1, S2102-2, , and S2102-n) . 

Accordingly, the processing of these S2102-1, S2102-2, , 

and S2102-n corresponds to the priority parameter 
asymptotic means in the first invention. And, each time 
the priority parameters are updated, the values of the 

10 search objects of the current time's gait parameter 

including the updated priority parameters are searched for, 
using the values determined immediately before the update 
as the initial value candidates, such that the boundary 
condition of the current time's gait is satisfied, and a 

15 current time's gait parameter that includes the search 

objects as the search results is newly determined (S2104-1, 

2104-2, , and S2104-n) . Accordingly, the processing of 

these S2104-1, 2104-2, , and S2104-n corresponds to the 

new gait parameter determining means in the first invention, 

20 and a current time's gait parameter including search 

objects finally determined in each processing corresponds 
to a new gait parameter in the first invention. And, the 
new current time's gait parameter finally determined in 
S2104-n will be the gait parameter of the current time's 

25 gait to be generated. 

Supplementally, the total number n of repetitions 
of the aforesaid repetitive processing is determined on the 
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basis of the difference between the value of a priority 
parameter of the current time's gait parameter determined 
in S2100 and the value of the priority parameter determined 
in S026 (a priority parameter required value) . Of the 
5 current time's gait parameter, the parameters (fixed 
parameters) other than priority parameters and search 
object parameters are maintained at the values of the 
appropriate parameters of the current time's gait parameter 
determined in S2100. 

10 The processing of Fig. 17 explained above updates 

the values of the priority parameters of a provisional 
current time's gait parameter (the current time's gait 
parameter determined in the past such that a boundary 
condition of a current time's gait is satisfied) determined 

15 in S2100 so as to gradually bring the values close to the 
values of the priority parameters determined in S026 (the 
priority parameters of a current time's gait to be 
generated) , and each time the values are updated, a current 
time's gait parameter that satisfies a boundary condition 

20 is newly determined. This makes it possible to efficiently 
and promptly create a current time's gait that satisfies 
the boundary condition without causing body 
position/posture to diverge. 

Returning to the explanation of Fig. 12, after the 

25 processing of S028 is carried out as explained above, the 
procedure proceeds to S030 wherein the parameters that 
define a ZMP permissible range for full-model correction 
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and a floor reaction force horizontal component permissible 
range are determined. 

This processing is the same as the processing of 
S030 shown in Fig. 13 in the aforesaid publication document 
5 1, so that the explanation herein will be omitted. 

The processing of S018 to S030 explained above is 
the processing carried out by the aforesaid gait parameter 
determiner 100a shown in Fig. 5. 

After the processing of S030 is carried out, or if 

10 the determination result of S016 is NO, then the procedure 
proceeds to S032 wherein the instantaneous values of the 
current time's gait are determined one after another. The 
subroutine processing of this processing is the same as the 
aforesaid processing of the flowchart of Fig. 19 explained 

15 in relation to generating a provisional current time's gait. 
In this case, as the ZMP parameter "a" and the first peak 
value ZMPrecpeeka and the second peak value ZMPrecpeekb of 
a body inclination restoring moment ZMP-converted value, 
the ones finally determined in S028 of Fig. 12 (the ones 

20 finally searched for in the processing of S2104-n of Fig. 
17) are used. 

Subsequently, the procedure proceeds to S034 
wherein the operation of the arm bodies 5, 5 to cancel a 
spin (the rotation about a vertical axis) of the robot 1 is 

25 determined. This processing is for determining the 

postures of the arm bodies 5, 5 such that a floor reaction 
force moment in the opposite direction from the vertical 
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component of the floor reaction force moment, which would 
be generated about a desired ZMP if the robot 1 were 
operated according to a desired gait without swinging the 
arms of the robot 1, is generated by the arm swings of the 
5 arm bodies 5, 5 (a motion of swinging the two arm bodies 5, 
5 back and forth in the opposite directions from each 
other) This is performed in exactly the same manner as 
that in S034 of Fig. 13 in the aforesaid publication 
document 1. The details thereof. are described in the 
10 publication document 1, so that no further explanation will 
be given. 

Subsequently, the procedure proceeds to S036 
wherein the instantaneous value of the ZMP permissible 
range and the instantaneous value of the floor reaction 

15 force horizontal component permissible range for full-model 
correction (for the processing of the aforesaid full-model 
corrector lOOe) are determined. In this processing, they 
are determined on the basis of a gait parameter that 
defines the ZMP permissible range and the floor reaction 

20 force horizontal component permissible range determined in 
S030 described above. 

The processing of S032 to S03.6 explained above is 
the detailed processing carried out by the aforesaid 
desired instantaneous value generator 100b in Fig. 5 

25 described above. 

Subsequently, the procedure proceeds to S038 
wherein a corrected gait using a full model is generated. 
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This processing is the processing carried out by the 
aforesaid full-model corrector 100c. In this case, the 
processing is the same as the processing of S038 of Fig. 13 
in the aforesaid publication document 1, and it is carried 
5 out according as described in the publication document 1. 

Hence, detailed explanation thereof will be omitted in the 
present description. This processing determines a 
corrected desired body position/posture, which is obtained 
by further correcting the desired body position/posture 

10 (the body position/posture of the aforesaid displacement- 

dimension corrected gait) , and a corrected desired floor 
reaction force moment. 

The above is the gait generation processing of the 
gait generating device 100 in the present embodiment. 

15 The operation of the composite-compliance control 

unit 101 will now be explained with reference to Fig. 4. 
Incidentally, the operation of the composite-compliance 
control unit 101 is described in detail in Japanese 
Unexamined Patent Application Publication No. H10-277969 

20 and the like previously applied by the present applicant; 

therefore, only schematic explanation will be given in the 
present description. In the gait generating device 100, 
the corrected desired body position/posture (trajectory) 
and the desired arm posture (trajectory) out of the desired 

25 gait generated as described above are sent out to a robot 
geometric model (inverse kinematics calculator) 102. 
Further, the desired foot position/posture 
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(trajectory) , the desired ZMP trajectory (the desired total 
floor reaction force central point trajectory) , and the 
desired total floor reaction force (trajectory) (the 
corrected desired floor reaction force moment and the 
5 desired floor reaction force vertical component) are sent 
to the composite-compliance operation determiner 104 and 
also to a desired floor reaction force distributor 106. 
Then, in the desired floor reaction force distributor 106, 
the floor reaction force is distributed to each foot 22 and 

10 the desired each foot floor reaction force central point 
and the desired each foot floor reaction force are 
determined. The determined desired each foot floor 
reaction force central point and the desired each foot 
floor reaction force are sent to the composite-compliance 

15 operation determiner 104. 

Corrected desired foot position/posture 
(trajectory) with deformation compensation is sent from the 
composite-compliance operation determiner 104 to the robot 
geometric model 102. Upon receipt of the desired body 

20 position/posture (trajectory) and the corrected desired 
foot position/posture (trajectory) with deformation 
compensation, the robot geometric model 102 calculates the 
joint displacement commands (values) of the twelve joints 
of the leg bodies 2, 2 that satisfy them and sends the 

25 calculated commands to a displacement controller 108. The 
displacement controller 108 carries out follow-up control 
of the displacements of the twelve joints of the robot 1, 
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using the joint displacement commands (values) calculated 
by the robot geometric model 102 as the desired values. 
Further, the robot geometric model 102 calculates 
displacement commands (values) of arm joints that satisfy 
5 desired arm postures and sends them to the displacement 
controller 108. The displacement controller 108 carries 
out follow-up control of the displacements of the twelve 
joints of the arm bodies of the robot 1, using the joint 
displacement commands (values) calculated in the robot 

10 geometric model 102 as desired values. 

The floor reaction forces (specifically, the actual 
each foot floor reaction force) generated in the robot 1 
are detected by the six-axis force sensor 50. The detected 
values are sent to the aforesaid composite-compliance 

15 operation determiner 104. Further, posture inclination 

errors 9errx and Gerry (specifically, the errors of actual 
posture angles relative to the desired body posture angle, 
the posture angle error in the roll direction (about the X- 
axis) being denoted by Berrx and the posture angle error in 

20 the pitch direction (about the Y-axis) being denoted by 
9erry) generated in the robot 1 are detected through the 
intermediary of a posture sensor 54, and the detected 
values are sent to a posture stabilization control 
calculator 112. The posture stabilization control 

25 calculator 112 calculates the compensating total floor 
reaction force's moment about the desired total floor 
reaction force central point (the desired ZMP) for 
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restoring the body posture angle of the robot 1 to the 
desired body posture angle and sends the calculation result 
to the composite-compliance operation determiner 104. The 
composite-compliance operation determiner 104 corrects the 
5 desired floor reaction force on the basis of the input 

value. To be specific, the desired floor reaction force is 
corrected such that the compensating total floor reaction 
force' s moment or the sum of the compensating total floor 
reaction force' s moment and the corrected desired floor 

10 reaction force moment acts about the desired total floor 
reaction force central point (the desired ZMP) . 

The composite-compliance operation determiner 104 
determines the aforesaid corrected desired foot 
position/posture (trajectory) with deformation compensation 

15 so as to make the states of the actual robot and the floor 
reaction force calculated from sensor-detected values or 
the like coincide with the desired floor reaction force 
that has been corrected. In this case, the corrected 
desired foot position/posture with deformation compensation 

20 considers the mechanical deformation of the aforesaid 
compliance mechanism 72 and the like. However, it is 
virtually impossible to make all states agree with desired 
values, so that a trade-off relationship is imparted among 
them to make them compromisingly agree as much as possible. 

25 More specifically, a control error for each desired value 
is weighted in conducting control so that the weighted 
average of the control error (or the square of the control 
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error) is minimized. Thus, actual foot position/posture 
and total floor reaction force are controlled so as to 
approximately follow the desired foot position/posture and 
the desired total floor reaction force. 
5 In the embodiment explained above, the gait 

parameters (a normal gait parameter and a current time's 
gait parameter) have been gradually updated, beginning with 
the ones associated with last time's gaits (the gaits 
determined in the past); alternatively, however, in either 

10 a normal gait or a current time's gait, a standard 

(reference) gait parameter that satisfies a boundary 
condition of the gait may be prepared (created) and 
retained in memory in advance, and then this may be used as 
a starting point to gradually update a gait parameter. For 

15 instance, the estimated landing position/posture of a free 
leg foot 22 related to a foot trajectory parameter of the 
current time's gait may be gradually updated from the 
position/posture at which the robot 1 steps at the same 
spot to the position/posture based on a required value, or 

20 the walking cycle thereof may be gradually updated. 

In the embodiment described above, it has been the 
boundary condition on the current time's gait that the 
divergence component at the terminating end of the current 
time's gait substantially agrees with the initial 

25 divergence component of a normal gait in order to bring the 
current time's gait close to the normal gait, and the 
search objects of the current time's gait parameter have 
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been searched for and determined to satisfy the boundary 
condition. Alternatively, however, the boundary condition 
of the current time's gait may be set such that the body 
position (the horizontal position and the vertical 
5 position) and the body velocity (the horizontal velocity 
and the vertical velocity) at the terminating end of the 
current time's gait substantially agree with the body 
position and the body velocity, respectively, at the 
beginning of the normal gait, and the search objects of the 

10 current time's gait parameter may be searched for and 

determined so that the boundary condition is satisfied. 

Alternatively, the boundary condition may be set 
such that the weighted average values of the position of 
the total center-of-gravity of the robot 1 and the changing 

15 velocity thereof at the terminating end of the current 

time's gait substantially agree with the weighted average 
values at the beginning of the normal gait, and the search 
objects of the current time's gait parameter may be 
determined such that the boundary condition is satisfied. 

20 Further, when determining a normal gait parameter, 

the aforesaid weighted mean values of the robot 1 or 
divergence components may be used as the search objects of 
a normal gait parameter to satisfy the boundary condition 
of the normal gait. Incidentally, a weighted mean value 

25 becomes equivalent to a divergence component (more 

precisely, proportional to a divergence component) by 
setting a predetermined weight if an absolute magnitude is 
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ignored. 

Industrial Applicability 

As is obvious from the above explanation, the gait 

generating system for a mobile robot in accordance with the 
5 present invention is useful in that it is capable of 

efficiently generating a gait that makes it possible to 

satisfy a predetermined boundary condition, while 

preventing divergence of the gait, and capable of 

generating a gait of a mobile robot, such as a biped mobile 
10 robot in particular, which inherently has low stability, 

while securing the stability of the mobile robot. 

Brief Description of the Drawings 

[Fig. 1] Fig. 1 is a diagram showing the overview 

of the entire construction of a mobile robot (a bipedal 
15 walking robot) to which an embodiment of the present 

invention is applied. 

[Fig. 2] Fig. 2 is a side view showing the 

construction of a foot portion of each leg of the robot 

shown in Fig. 1. 
20 [Fig. 3] Fig. 3 is a block diagram showing the 

construction of a control unit provided in the robot shown 

in Fig. 1. 

[Fig. 4] Fig. 4 is a block diagram showing the 
functional construction of the control unit shown in Fig. 3. 
25 [Fig. 5] Fig. 5 is a block diagram showing the 

functions of a gait generating device shown in Fig. 4. 

[Fig. 6] Figs. 6(a) and (b) are diagrams for 
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explaining the motion modes (a body t ranslat ional mode and 
a body rotation mode), respectively, of the robot. 

[Fig. 7] Fig. 7 is a diagram showing the structure 
of a dynamic model used for generating gaits. 

[Fig. 8] Fig. 8 is a block diagram showing the 
structure of a full model used for generating gaits. 

[Fig. 9] Fig. 9 is a flowchart showing the main 
routine processing of the gait generating device in the 
embodiment . 
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[Fig. 19] Fig. 19 is a flowchart showing the 
subroutine processing of Fig. 18. 

[Fig. 20] Fig. 20 is a graph showing examples of 
body inclination restoring moment ZMP-converted values in a 
5 normal gait. 

[Fig. 21] Fig. 21 is a graph showing examples of 
body inclination restoring moment ZMP-converted values in a 
current time's gait. 

[Fig. 22] Fig. 22 is a graph showing examples of a 
10 provisional desired ZMP, a ZMP correction amount, and a 
desired ZMP in a current time's gait. 



